smsc47b397.c 8.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * smsc47b397.c - Part of lm_sensors, Linux kernel modules
  4. * for hardware monitoring
  5. *
  6. * Supports the SMSC LPC47B397-NC Super-I/O chip.
  7. *
  8. * Author/Maintainer: Mark M. Hoffman <mhoffman@lightlink.com>
  9. * Copyright (C) 2004 Utilitek Systems, Inc.
  10. *
  11. * derived in part from smsc47m1.c:
  12. * Copyright (C) 2002 Mark D. Studebaker <mdsxyz123@yahoo.com>
  13. * Copyright (C) 2004 Jean Delvare <jdelvare@suse.de>
  14. */
  15. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  16. #include <linux/module.h>
  17. #include <linux/slab.h>
  18. #include <linux/ioport.h>
  19. #include <linux/jiffies.h>
  20. #include <linux/platform_device.h>
  21. #include <linux/hwmon.h>
  22. #include <linux/hwmon-sysfs.h>
  23. #include <linux/err.h>
  24. #include <linux/init.h>
  25. #include <linux/mutex.h>
  26. #include <linux/acpi.h>
  27. #include <linux/io.h>
  28. static unsigned short force_id;
  29. module_param(force_id, ushort, 0);
  30. MODULE_PARM_DESC(force_id, "Override the detected device ID");
  31. static struct platform_device *pdev;
  32. #define DRVNAME "smsc47b397"
  33. /* Super-I/0 registers and commands */
  34. #define REG 0x2e /* The register to read/write */
  35. #define VAL 0x2f /* The value to read/write */
  36. static inline void superio_outb(int reg, int val)
  37. {
  38. outb(reg, REG);
  39. outb(val, VAL);
  40. }
  41. static inline int superio_inb(int reg)
  42. {
  43. outb(reg, REG);
  44. return inb(VAL);
  45. }
  46. /* select superio logical device */
  47. static inline void superio_select(int ld)
  48. {
  49. superio_outb(0x07, ld);
  50. }
  51. static inline int superio_enter(void)
  52. {
  53. if (!request_muxed_region(REG, 2, DRVNAME))
  54. return -EBUSY;
  55. outb(0x55, REG);
  56. return 0;
  57. }
  58. static inline void superio_exit(void)
  59. {
  60. outb(0xAA, REG);
  61. release_region(REG, 2);
  62. }
  63. #define SUPERIO_REG_DEVID 0x20
  64. #define SUPERIO_REG_DEVREV 0x21
  65. #define SUPERIO_REG_BASE_MSB 0x60
  66. #define SUPERIO_REG_BASE_LSB 0x61
  67. #define SUPERIO_REG_LD8 0x08
  68. #define SMSC_EXTENT 0x02
  69. /* 0 <= nr <= 3 */
  70. static u8 smsc47b397_reg_temp[] = {0x25, 0x26, 0x27, 0x80};
  71. #define SMSC47B397_REG_TEMP(nr) (smsc47b397_reg_temp[(nr)])
  72. /* 0 <= nr <= 3 */
  73. #define SMSC47B397_REG_FAN_LSB(nr) (0x28 + 2 * (nr))
  74. #define SMSC47B397_REG_FAN_MSB(nr) (0x29 + 2 * (nr))
  75. struct smsc47b397_data {
  76. unsigned short addr;
  77. struct mutex lock;
  78. struct mutex update_lock;
  79. unsigned long last_updated; /* in jiffies */
  80. int valid;
  81. /* register values */
  82. u16 fan[4];
  83. u8 temp[4];
  84. };
  85. static int smsc47b397_read_value(struct smsc47b397_data *data, u8 reg)
  86. {
  87. int res;
  88. mutex_lock(&data->lock);
  89. outb(reg, data->addr);
  90. res = inb_p(data->addr + 1);
  91. mutex_unlock(&data->lock);
  92. return res;
  93. }
  94. static struct smsc47b397_data *smsc47b397_update_device(struct device *dev)
  95. {
  96. struct smsc47b397_data *data = dev_get_drvdata(dev);
  97. int i;
  98. mutex_lock(&data->update_lock);
  99. if (time_after(jiffies, data->last_updated + HZ) || !data->valid) {
  100. dev_dbg(dev, "starting device update...\n");
  101. /* 4 temperature inputs, 4 fan inputs */
  102. for (i = 0; i < 4; i++) {
  103. data->temp[i] = smsc47b397_read_value(data,
  104. SMSC47B397_REG_TEMP(i));
  105. /* must read LSB first */
  106. data->fan[i] = smsc47b397_read_value(data,
  107. SMSC47B397_REG_FAN_LSB(i));
  108. data->fan[i] |= smsc47b397_read_value(data,
  109. SMSC47B397_REG_FAN_MSB(i)) << 8;
  110. }
  111. data->last_updated = jiffies;
  112. data->valid = 1;
  113. dev_dbg(dev, "... device update complete\n");
  114. }
  115. mutex_unlock(&data->update_lock);
  116. return data;
  117. }
  118. /*
  119. * TEMP: 0.001C/bit (-128C to +127C)
  120. * REG: 1C/bit, two's complement
  121. */
  122. static int temp_from_reg(u8 reg)
  123. {
  124. return (s8)reg * 1000;
  125. }
  126. static ssize_t temp_show(struct device *dev, struct device_attribute *devattr,
  127. char *buf)
  128. {
  129. struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
  130. struct smsc47b397_data *data = smsc47b397_update_device(dev);
  131. return sprintf(buf, "%d\n", temp_from_reg(data->temp[attr->index]));
  132. }
  133. static SENSOR_DEVICE_ATTR_RO(temp1_input, temp, 0);
  134. static SENSOR_DEVICE_ATTR_RO(temp2_input, temp, 1);
  135. static SENSOR_DEVICE_ATTR_RO(temp3_input, temp, 2);
  136. static SENSOR_DEVICE_ATTR_RO(temp4_input, temp, 3);
  137. /*
  138. * FAN: 1 RPM/bit
  139. * REG: count of 90kHz pulses / revolution
  140. */
  141. static int fan_from_reg(u16 reg)
  142. {
  143. if (reg == 0 || reg == 0xffff)
  144. return 0;
  145. return 90000 * 60 / reg;
  146. }
  147. static ssize_t fan_show(struct device *dev, struct device_attribute *devattr,
  148. char *buf)
  149. {
  150. struct sensor_device_attribute *attr = to_sensor_dev_attr(devattr);
  151. struct smsc47b397_data *data = smsc47b397_update_device(dev);
  152. return sprintf(buf, "%d\n", fan_from_reg(data->fan[attr->index]));
  153. }
  154. static SENSOR_DEVICE_ATTR_RO(fan1_input, fan, 0);
  155. static SENSOR_DEVICE_ATTR_RO(fan2_input, fan, 1);
  156. static SENSOR_DEVICE_ATTR_RO(fan3_input, fan, 2);
  157. static SENSOR_DEVICE_ATTR_RO(fan4_input, fan, 3);
  158. static struct attribute *smsc47b397_attrs[] = {
  159. &sensor_dev_attr_temp1_input.dev_attr.attr,
  160. &sensor_dev_attr_temp2_input.dev_attr.attr,
  161. &sensor_dev_attr_temp3_input.dev_attr.attr,
  162. &sensor_dev_attr_temp4_input.dev_attr.attr,
  163. &sensor_dev_attr_fan1_input.dev_attr.attr,
  164. &sensor_dev_attr_fan2_input.dev_attr.attr,
  165. &sensor_dev_attr_fan3_input.dev_attr.attr,
  166. &sensor_dev_attr_fan4_input.dev_attr.attr,
  167. NULL
  168. };
  169. ATTRIBUTE_GROUPS(smsc47b397);
  170. static int smsc47b397_probe(struct platform_device *pdev);
  171. static struct platform_driver smsc47b397_driver = {
  172. .driver = {
  173. .name = DRVNAME,
  174. },
  175. .probe = smsc47b397_probe,
  176. };
  177. static int smsc47b397_probe(struct platform_device *pdev)
  178. {
  179. struct device *dev = &pdev->dev;
  180. struct smsc47b397_data *data;
  181. struct device *hwmon_dev;
  182. struct resource *res;
  183. res = platform_get_resource(pdev, IORESOURCE_IO, 0);
  184. if (!devm_request_region(dev, res->start, SMSC_EXTENT,
  185. smsc47b397_driver.driver.name)) {
  186. dev_err(dev, "Region 0x%lx-0x%lx already in use!\n",
  187. (unsigned long)res->start,
  188. (unsigned long)res->start + SMSC_EXTENT - 1);
  189. return -EBUSY;
  190. }
  191. data = devm_kzalloc(dev, sizeof(struct smsc47b397_data), GFP_KERNEL);
  192. if (!data)
  193. return -ENOMEM;
  194. data->addr = res->start;
  195. mutex_init(&data->lock);
  196. mutex_init(&data->update_lock);
  197. hwmon_dev = devm_hwmon_device_register_with_groups(dev, "smsc47b397",
  198. data,
  199. smsc47b397_groups);
  200. return PTR_ERR_OR_ZERO(hwmon_dev);
  201. }
  202. static int __init smsc47b397_device_add(unsigned short address)
  203. {
  204. struct resource res = {
  205. .start = address,
  206. .end = address + SMSC_EXTENT - 1,
  207. .name = DRVNAME,
  208. .flags = IORESOURCE_IO,
  209. };
  210. int err;
  211. err = acpi_check_resource_conflict(&res);
  212. if (err)
  213. goto exit;
  214. pdev = platform_device_alloc(DRVNAME, address);
  215. if (!pdev) {
  216. err = -ENOMEM;
  217. pr_err("Device allocation failed\n");
  218. goto exit;
  219. }
  220. err = platform_device_add_resources(pdev, &res, 1);
  221. if (err) {
  222. pr_err("Device resource addition failed (%d)\n", err);
  223. goto exit_device_put;
  224. }
  225. err = platform_device_add(pdev);
  226. if (err) {
  227. pr_err("Device addition failed (%d)\n", err);
  228. goto exit_device_put;
  229. }
  230. return 0;
  231. exit_device_put:
  232. platform_device_put(pdev);
  233. exit:
  234. return err;
  235. }
  236. static int __init smsc47b397_find(void)
  237. {
  238. u8 id, rev;
  239. char *name;
  240. unsigned short addr;
  241. int err;
  242. err = superio_enter();
  243. if (err)
  244. return err;
  245. id = force_id ? force_id : superio_inb(SUPERIO_REG_DEVID);
  246. switch (id) {
  247. case 0x81:
  248. name = "SCH5307-NS";
  249. break;
  250. case 0x6f:
  251. name = "LPC47B397-NC";
  252. break;
  253. case 0x85:
  254. case 0x8c:
  255. name = "SCH5317";
  256. break;
  257. default:
  258. superio_exit();
  259. return -ENODEV;
  260. }
  261. rev = superio_inb(SUPERIO_REG_DEVREV);
  262. superio_select(SUPERIO_REG_LD8);
  263. addr = (superio_inb(SUPERIO_REG_BASE_MSB) << 8)
  264. | superio_inb(SUPERIO_REG_BASE_LSB);
  265. pr_info("found SMSC %s (base address 0x%04x, revision %u)\n",
  266. name, addr, rev);
  267. superio_exit();
  268. return addr;
  269. }
  270. static int __init smsc47b397_init(void)
  271. {
  272. unsigned short address;
  273. int ret;
  274. ret = smsc47b397_find();
  275. if (ret < 0)
  276. return ret;
  277. address = ret;
  278. ret = platform_driver_register(&smsc47b397_driver);
  279. if (ret)
  280. goto exit;
  281. /* Sets global pdev as a side effect */
  282. ret = smsc47b397_device_add(address);
  283. if (ret)
  284. goto exit_driver;
  285. return 0;
  286. exit_driver:
  287. platform_driver_unregister(&smsc47b397_driver);
  288. exit:
  289. return ret;
  290. }
  291. static void __exit smsc47b397_exit(void)
  292. {
  293. platform_device_unregister(pdev);
  294. platform_driver_unregister(&smsc47b397_driver);
  295. }
  296. MODULE_AUTHOR("Mark M. Hoffman <mhoffman@lightlink.com>");
  297. MODULE_DESCRIPTION("SMSC LPC47B397 driver");
  298. MODULE_LICENSE("GPL");
  299. module_init(smsc47b397_init);
  300. module_exit(smsc47b397_exit);