w83781d.c 56 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * w83781d.c - Part of lm_sensors, Linux kernel modules for hardware
  4. * monitoring
  5. * Copyright (c) 1998 - 2001 Frodo Looijaard <frodol@dds.nl>,
  6. * Philip Edelbrock <phil@netroedge.com>,
  7. * and Mark Studebaker <mdsxyz123@yahoo.com>
  8. * Copyright (c) 2007 - 2008 Jean Delvare <jdelvare@suse.de>
  9. */
  10. /*
  11. * Supports following chips:
  12. *
  13. * Chip #vin #fanin #pwm #temp wchipid vendid i2c ISA
  14. * as99127f 7 3 0 3 0x31 0x12c3 yes no
  15. * as99127f rev.2 (type_name = as99127f) 0x31 0x5ca3 yes no
  16. * w83781d 7 3 0 3 0x10-1 0x5ca3 yes yes
  17. * w83782d 9 3 2-4 3 0x30 0x5ca3 yes yes
  18. * w83783s 5-6 3 2 1-2 0x40 0x5ca3 yes no
  19. *
  20. */
  21. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  22. #include <linux/module.h>
  23. #include <linux/init.h>
  24. #include <linux/slab.h>
  25. #include <linux/jiffies.h>
  26. #include <linux/i2c.h>
  27. #include <linux/hwmon.h>
  28. #include <linux/hwmon-vid.h>
  29. #include <linux/hwmon-sysfs.h>
  30. #include <linux/sysfs.h>
  31. #include <linux/err.h>
  32. #include <linux/mutex.h>
  33. #ifdef CONFIG_ISA
  34. #include <linux/platform_device.h>
  35. #include <linux/ioport.h>
  36. #include <linux/io.h>
  37. #endif
  38. #include "lm75.h"
  39. /* Addresses to scan */
  40. static const unsigned short normal_i2c[] = { 0x28, 0x29, 0x2a, 0x2b, 0x2c, 0x2d,
  41. 0x2e, 0x2f, I2C_CLIENT_END };
  42. enum chips { w83781d, w83782d, w83783s, as99127f };
  43. /* Insmod parameters */
  44. static unsigned short force_subclients[4];
  45. module_param_array(force_subclients, short, NULL, 0);
  46. MODULE_PARM_DESC(force_subclients,
  47. "List of subclient addresses: {bus, clientaddr, subclientaddr1, subclientaddr2}");
  48. static bool reset;
  49. module_param(reset, bool, 0);
  50. MODULE_PARM_DESC(reset, "Set to one to reset chip on load");
  51. static bool init = 1;
  52. module_param(init, bool, 0);
  53. MODULE_PARM_DESC(init, "Set to zero to bypass chip initialization");
  54. /* Constants specified below */
  55. /* Length of ISA address segment */
  56. #define W83781D_EXTENT 8
  57. /* Where are the ISA address/data registers relative to the base address */
  58. #define W83781D_ADDR_REG_OFFSET 5
  59. #define W83781D_DATA_REG_OFFSET 6
  60. /* The device registers */
  61. /* in nr from 0 to 8 */
  62. #define W83781D_REG_IN_MAX(nr) ((nr < 7) ? (0x2b + (nr) * 2) : \
  63. (0x554 + (((nr) - 7) * 2)))
  64. #define W83781D_REG_IN_MIN(nr) ((nr < 7) ? (0x2c + (nr) * 2) : \
  65. (0x555 + (((nr) - 7) * 2)))
  66. #define W83781D_REG_IN(nr) ((nr < 7) ? (0x20 + (nr)) : \
  67. (0x550 + (nr) - 7))
  68. /* fan nr from 0 to 2 */
  69. #define W83781D_REG_FAN_MIN(nr) (0x3b + (nr))
  70. #define W83781D_REG_FAN(nr) (0x28 + (nr))
  71. #define W83781D_REG_BANK 0x4E
  72. #define W83781D_REG_TEMP2_CONFIG 0x152
  73. #define W83781D_REG_TEMP3_CONFIG 0x252
  74. /* temp nr from 1 to 3 */
  75. #define W83781D_REG_TEMP(nr) ((nr == 3) ? (0x0250) : \
  76. ((nr == 2) ? (0x0150) : \
  77. (0x27)))
  78. #define W83781D_REG_TEMP_HYST(nr) ((nr == 3) ? (0x253) : \
  79. ((nr == 2) ? (0x153) : \
  80. (0x3A)))
  81. #define W83781D_REG_TEMP_OVER(nr) ((nr == 3) ? (0x255) : \
  82. ((nr == 2) ? (0x155) : \
  83. (0x39)))
  84. #define W83781D_REG_CONFIG 0x40
  85. /* Interrupt status (W83781D, AS99127F) */
  86. #define W83781D_REG_ALARM1 0x41
  87. #define W83781D_REG_ALARM2 0x42
  88. /* Real-time status (W83782D, W83783S) */
  89. #define W83782D_REG_ALARM1 0x459
  90. #define W83782D_REG_ALARM2 0x45A
  91. #define W83782D_REG_ALARM3 0x45B
  92. #define W83781D_REG_BEEP_CONFIG 0x4D
  93. #define W83781D_REG_BEEP_INTS1 0x56
  94. #define W83781D_REG_BEEP_INTS2 0x57
  95. #define W83781D_REG_BEEP_INTS3 0x453 /* not on W83781D */
  96. #define W83781D_REG_VID_FANDIV 0x47
  97. #define W83781D_REG_CHIPID 0x49
  98. #define W83781D_REG_WCHIPID 0x58
  99. #define W83781D_REG_CHIPMAN 0x4F
  100. #define W83781D_REG_PIN 0x4B
  101. /* 782D/783S only */
  102. #define W83781D_REG_VBAT 0x5D
  103. /* PWM 782D (1-4) and 783S (1-2) only */
  104. static const u8 W83781D_REG_PWM[] = { 0x5B, 0x5A, 0x5E, 0x5F };
  105. #define W83781D_REG_PWMCLK12 0x5C
  106. #define W83781D_REG_PWMCLK34 0x45C
  107. #define W83781D_REG_I2C_ADDR 0x48
  108. #define W83781D_REG_I2C_SUBADDR 0x4A
  109. /*
  110. * The following are undocumented in the data sheets however we
  111. * received the information in an email from Winbond tech support
  112. */
  113. /* Sensor selection - not on 781d */
  114. #define W83781D_REG_SCFG1 0x5D
  115. static const u8 BIT_SCFG1[] = { 0x02, 0x04, 0x08 };
  116. #define W83781D_REG_SCFG2 0x59
  117. static const u8 BIT_SCFG2[] = { 0x10, 0x20, 0x40 };
  118. #define W83781D_DEFAULT_BETA 3435
  119. /* Conversions */
  120. #define IN_TO_REG(val) clamp_val(((val) + 8) / 16, 0, 255)
  121. #define IN_FROM_REG(val) ((val) * 16)
  122. static inline u8
  123. FAN_TO_REG(long rpm, int div)
  124. {
  125. if (rpm == 0)
  126. return 255;
  127. rpm = clamp_val(rpm, 1, 1000000);
  128. return clamp_val((1350000 + rpm * div / 2) / (rpm * div), 1, 254);
  129. }
  130. static inline long
  131. FAN_FROM_REG(u8 val, int div)
  132. {
  133. if (val == 0)
  134. return -1;
  135. if (val == 255)
  136. return 0;
  137. return 1350000 / (val * div);
  138. }
  139. #define TEMP_TO_REG(val) clamp_val((val) / 1000, -127, 128)
  140. #define TEMP_FROM_REG(val) ((val) * 1000)
  141. #define BEEP_MASK_FROM_REG(val, type) ((type) == as99127f ? \
  142. (~(val)) & 0x7fff : (val) & 0xff7fff)
  143. #define BEEP_MASK_TO_REG(val, type) ((type) == as99127f ? \
  144. (~(val)) & 0x7fff : (val) & 0xff7fff)
  145. #define DIV_FROM_REG(val) (1 << (val))
  146. static inline u8
  147. DIV_TO_REG(long val, enum chips type)
  148. {
  149. int i;
  150. val = clamp_val(val, 1,
  151. ((type == w83781d || type == as99127f) ? 8 : 128)) >> 1;
  152. for (i = 0; i < 7; i++) {
  153. if (val == 0)
  154. break;
  155. val >>= 1;
  156. }
  157. return i;
  158. }
  159. struct w83781d_data {
  160. struct i2c_client *client;
  161. struct device *hwmon_dev;
  162. struct mutex lock;
  163. enum chips type;
  164. /* For ISA device only */
  165. const char *name;
  166. int isa_addr;
  167. struct mutex update_lock;
  168. bool valid; /* true if following fields are valid */
  169. unsigned long last_updated; /* In jiffies */
  170. struct i2c_client *lm75[2]; /* for secondary I2C addresses */
  171. /* array of 2 pointers to subclients */
  172. u8 in[9]; /* Register value - 8 & 9 for 782D only */
  173. u8 in_max[9]; /* Register value - 8 & 9 for 782D only */
  174. u8 in_min[9]; /* Register value - 8 & 9 for 782D only */
  175. u8 fan[3]; /* Register value */
  176. u8 fan_min[3]; /* Register value */
  177. s8 temp; /* Register value */
  178. s8 temp_max; /* Register value */
  179. s8 temp_max_hyst; /* Register value */
  180. u16 temp_add[2]; /* Register value */
  181. u16 temp_max_add[2]; /* Register value */
  182. u16 temp_max_hyst_add[2]; /* Register value */
  183. u8 fan_div[3]; /* Register encoding, shifted right */
  184. u8 vid; /* Register encoding, combined */
  185. u32 alarms; /* Register encoding, combined */
  186. u32 beep_mask; /* Register encoding, combined */
  187. u8 pwm[4]; /* Register value */
  188. u8 pwm2_enable; /* Boolean */
  189. u16 sens[3]; /*
  190. * 782D/783S only.
  191. * 1 = pentium diode; 2 = 3904 diode;
  192. * 4 = thermistor
  193. */
  194. u8 vrm;
  195. };
  196. static struct w83781d_data *w83781d_data_if_isa(void);
  197. static int w83781d_alias_detect(struct i2c_client *client, u8 chipid);
  198. static int w83781d_read_value(struct w83781d_data *data, u16 reg);
  199. static int w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value);
  200. static struct w83781d_data *w83781d_update_device(struct device *dev);
  201. static void w83781d_init_device(struct device *dev);
  202. /* following are the sysfs callback functions */
  203. #define show_in_reg(reg) \
  204. static ssize_t show_##reg(struct device *dev, struct device_attribute *da, \
  205. char *buf) \
  206. { \
  207. struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
  208. struct w83781d_data *data = w83781d_update_device(dev); \
  209. return sprintf(buf, "%ld\n", \
  210. (long)IN_FROM_REG(data->reg[attr->index])); \
  211. }
  212. show_in_reg(in);
  213. show_in_reg(in_min);
  214. show_in_reg(in_max);
  215. #define store_in_reg(REG, reg) \
  216. static ssize_t store_in_##reg(struct device *dev, struct device_attribute \
  217. *da, const char *buf, size_t count) \
  218. { \
  219. struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
  220. struct w83781d_data *data = dev_get_drvdata(dev); \
  221. int nr = attr->index; \
  222. unsigned long val; \
  223. int err = kstrtoul(buf, 10, &val); \
  224. if (err) \
  225. return err; \
  226. mutex_lock(&data->update_lock); \
  227. data->in_##reg[nr] = IN_TO_REG(val); \
  228. w83781d_write_value(data, W83781D_REG_IN_##REG(nr), \
  229. data->in_##reg[nr]); \
  230. \
  231. mutex_unlock(&data->update_lock); \
  232. return count; \
  233. }
  234. store_in_reg(MIN, min);
  235. store_in_reg(MAX, max);
  236. #define sysfs_in_offsets(offset) \
  237. static SENSOR_DEVICE_ATTR(in##offset##_input, S_IRUGO, \
  238. show_in, NULL, offset); \
  239. static SENSOR_DEVICE_ATTR(in##offset##_min, S_IRUGO | S_IWUSR, \
  240. show_in_min, store_in_min, offset); \
  241. static SENSOR_DEVICE_ATTR(in##offset##_max, S_IRUGO | S_IWUSR, \
  242. show_in_max, store_in_max, offset)
  243. sysfs_in_offsets(0);
  244. sysfs_in_offsets(1);
  245. sysfs_in_offsets(2);
  246. sysfs_in_offsets(3);
  247. sysfs_in_offsets(4);
  248. sysfs_in_offsets(5);
  249. sysfs_in_offsets(6);
  250. sysfs_in_offsets(7);
  251. sysfs_in_offsets(8);
  252. #define show_fan_reg(reg) \
  253. static ssize_t show_##reg(struct device *dev, struct device_attribute *da, \
  254. char *buf) \
  255. { \
  256. struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
  257. struct w83781d_data *data = w83781d_update_device(dev); \
  258. return sprintf(buf, "%ld\n", \
  259. FAN_FROM_REG(data->reg[attr->index], \
  260. DIV_FROM_REG(data->fan_div[attr->index]))); \
  261. }
  262. show_fan_reg(fan);
  263. show_fan_reg(fan_min);
  264. static ssize_t
  265. store_fan_min(struct device *dev, struct device_attribute *da,
  266. const char *buf, size_t count)
  267. {
  268. struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
  269. struct w83781d_data *data = dev_get_drvdata(dev);
  270. int nr = attr->index;
  271. unsigned long val;
  272. int err;
  273. err = kstrtoul(buf, 10, &val);
  274. if (err)
  275. return err;
  276. mutex_lock(&data->update_lock);
  277. data->fan_min[nr] =
  278. FAN_TO_REG(val, DIV_FROM_REG(data->fan_div[nr]));
  279. w83781d_write_value(data, W83781D_REG_FAN_MIN(nr),
  280. data->fan_min[nr]);
  281. mutex_unlock(&data->update_lock);
  282. return count;
  283. }
  284. static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan, NULL, 0);
  285. static SENSOR_DEVICE_ATTR(fan1_min, S_IRUGO | S_IWUSR,
  286. show_fan_min, store_fan_min, 0);
  287. static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan, NULL, 1);
  288. static SENSOR_DEVICE_ATTR(fan2_min, S_IRUGO | S_IWUSR,
  289. show_fan_min, store_fan_min, 1);
  290. static SENSOR_DEVICE_ATTR(fan3_input, S_IRUGO, show_fan, NULL, 2);
  291. static SENSOR_DEVICE_ATTR(fan3_min, S_IRUGO | S_IWUSR,
  292. show_fan_min, store_fan_min, 2);
  293. #define show_temp_reg(reg) \
  294. static ssize_t show_##reg(struct device *dev, struct device_attribute *da, \
  295. char *buf) \
  296. { \
  297. struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
  298. struct w83781d_data *data = w83781d_update_device(dev); \
  299. int nr = attr->index; \
  300. if (nr >= 2) { /* TEMP2 and TEMP3 */ \
  301. return sprintf(buf, "%d\n", \
  302. LM75_TEMP_FROM_REG(data->reg##_add[nr-2])); \
  303. } else { /* TEMP1 */ \
  304. return sprintf(buf, "%ld\n", (long)TEMP_FROM_REG(data->reg)); \
  305. } \
  306. }
  307. show_temp_reg(temp);
  308. show_temp_reg(temp_max);
  309. show_temp_reg(temp_max_hyst);
  310. #define store_temp_reg(REG, reg) \
  311. static ssize_t store_temp_##reg(struct device *dev, \
  312. struct device_attribute *da, const char *buf, size_t count) \
  313. { \
  314. struct sensor_device_attribute *attr = to_sensor_dev_attr(da); \
  315. struct w83781d_data *data = dev_get_drvdata(dev); \
  316. int nr = attr->index; \
  317. long val; \
  318. int err = kstrtol(buf, 10, &val); \
  319. if (err) \
  320. return err; \
  321. mutex_lock(&data->update_lock); \
  322. \
  323. if (nr >= 2) { /* TEMP2 and TEMP3 */ \
  324. data->temp_##reg##_add[nr-2] = LM75_TEMP_TO_REG(val); \
  325. w83781d_write_value(data, W83781D_REG_TEMP_##REG(nr), \
  326. data->temp_##reg##_add[nr-2]); \
  327. } else { /* TEMP1 */ \
  328. data->temp_##reg = TEMP_TO_REG(val); \
  329. w83781d_write_value(data, W83781D_REG_TEMP_##REG(nr), \
  330. data->temp_##reg); \
  331. } \
  332. \
  333. mutex_unlock(&data->update_lock); \
  334. return count; \
  335. }
  336. store_temp_reg(OVER, max);
  337. store_temp_reg(HYST, max_hyst);
  338. #define sysfs_temp_offsets(offset) \
  339. static SENSOR_DEVICE_ATTR(temp##offset##_input, S_IRUGO, \
  340. show_temp, NULL, offset); \
  341. static SENSOR_DEVICE_ATTR(temp##offset##_max, S_IRUGO | S_IWUSR, \
  342. show_temp_max, store_temp_max, offset); \
  343. static SENSOR_DEVICE_ATTR(temp##offset##_max_hyst, S_IRUGO | S_IWUSR, \
  344. show_temp_max_hyst, store_temp_max_hyst, offset);
  345. sysfs_temp_offsets(1);
  346. sysfs_temp_offsets(2);
  347. sysfs_temp_offsets(3);
  348. static ssize_t
  349. cpu0_vid_show(struct device *dev, struct device_attribute *attr, char *buf)
  350. {
  351. struct w83781d_data *data = w83781d_update_device(dev);
  352. return sprintf(buf, "%ld\n", (long) vid_from_reg(data->vid, data->vrm));
  353. }
  354. static DEVICE_ATTR_RO(cpu0_vid);
  355. static ssize_t
  356. vrm_show(struct device *dev, struct device_attribute *attr, char *buf)
  357. {
  358. struct w83781d_data *data = dev_get_drvdata(dev);
  359. return sprintf(buf, "%ld\n", (long) data->vrm);
  360. }
  361. static ssize_t
  362. vrm_store(struct device *dev, struct device_attribute *attr, const char *buf,
  363. size_t count)
  364. {
  365. struct w83781d_data *data = dev_get_drvdata(dev);
  366. unsigned long val;
  367. int err;
  368. err = kstrtoul(buf, 10, &val);
  369. if (err)
  370. return err;
  371. data->vrm = clamp_val(val, 0, 255);
  372. return count;
  373. }
  374. static DEVICE_ATTR_RW(vrm);
  375. static ssize_t
  376. alarms_show(struct device *dev, struct device_attribute *attr, char *buf)
  377. {
  378. struct w83781d_data *data = w83781d_update_device(dev);
  379. return sprintf(buf, "%u\n", data->alarms);
  380. }
  381. static DEVICE_ATTR_RO(alarms);
  382. static ssize_t show_alarm(struct device *dev, struct device_attribute *attr,
  383. char *buf)
  384. {
  385. struct w83781d_data *data = w83781d_update_device(dev);
  386. int bitnr = to_sensor_dev_attr(attr)->index;
  387. return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
  388. }
  389. /* The W83781D has a single alarm bit for temp2 and temp3 */
  390. static ssize_t show_temp3_alarm(struct device *dev,
  391. struct device_attribute *attr, char *buf)
  392. {
  393. struct w83781d_data *data = w83781d_update_device(dev);
  394. int bitnr = (data->type == w83781d) ? 5 : 13;
  395. return sprintf(buf, "%u\n", (data->alarms >> bitnr) & 1);
  396. }
  397. static SENSOR_DEVICE_ATTR(in0_alarm, S_IRUGO, show_alarm, NULL, 0);
  398. static SENSOR_DEVICE_ATTR(in1_alarm, S_IRUGO, show_alarm, NULL, 1);
  399. static SENSOR_DEVICE_ATTR(in2_alarm, S_IRUGO, show_alarm, NULL, 2);
  400. static SENSOR_DEVICE_ATTR(in3_alarm, S_IRUGO, show_alarm, NULL, 3);
  401. static SENSOR_DEVICE_ATTR(in4_alarm, S_IRUGO, show_alarm, NULL, 8);
  402. static SENSOR_DEVICE_ATTR(in5_alarm, S_IRUGO, show_alarm, NULL, 9);
  403. static SENSOR_DEVICE_ATTR(in6_alarm, S_IRUGO, show_alarm, NULL, 10);
  404. static SENSOR_DEVICE_ATTR(in7_alarm, S_IRUGO, show_alarm, NULL, 16);
  405. static SENSOR_DEVICE_ATTR(in8_alarm, S_IRUGO, show_alarm, NULL, 17);
  406. static SENSOR_DEVICE_ATTR(fan1_alarm, S_IRUGO, show_alarm, NULL, 6);
  407. static SENSOR_DEVICE_ATTR(fan2_alarm, S_IRUGO, show_alarm, NULL, 7);
  408. static SENSOR_DEVICE_ATTR(fan3_alarm, S_IRUGO, show_alarm, NULL, 11);
  409. static SENSOR_DEVICE_ATTR(temp1_alarm, S_IRUGO, show_alarm, NULL, 4);
  410. static SENSOR_DEVICE_ATTR(temp2_alarm, S_IRUGO, show_alarm, NULL, 5);
  411. static SENSOR_DEVICE_ATTR(temp3_alarm, S_IRUGO, show_temp3_alarm, NULL, 0);
  412. static ssize_t beep_mask_show(struct device *dev,
  413. struct device_attribute *attr, char *buf)
  414. {
  415. struct w83781d_data *data = w83781d_update_device(dev);
  416. return sprintf(buf, "%ld\n",
  417. (long)BEEP_MASK_FROM_REG(data->beep_mask, data->type));
  418. }
  419. static ssize_t
  420. beep_mask_store(struct device *dev, struct device_attribute *attr,
  421. const char *buf, size_t count)
  422. {
  423. struct w83781d_data *data = dev_get_drvdata(dev);
  424. unsigned long val;
  425. int err;
  426. err = kstrtoul(buf, 10, &val);
  427. if (err)
  428. return err;
  429. mutex_lock(&data->update_lock);
  430. data->beep_mask &= 0x8000; /* preserve beep enable */
  431. data->beep_mask |= BEEP_MASK_TO_REG(val, data->type);
  432. w83781d_write_value(data, W83781D_REG_BEEP_INTS1,
  433. data->beep_mask & 0xff);
  434. w83781d_write_value(data, W83781D_REG_BEEP_INTS2,
  435. (data->beep_mask >> 8) & 0xff);
  436. if (data->type != w83781d && data->type != as99127f) {
  437. w83781d_write_value(data, W83781D_REG_BEEP_INTS3,
  438. ((data->beep_mask) >> 16) & 0xff);
  439. }
  440. mutex_unlock(&data->update_lock);
  441. return count;
  442. }
  443. static DEVICE_ATTR_RW(beep_mask);
  444. static ssize_t show_beep(struct device *dev, struct device_attribute *attr,
  445. char *buf)
  446. {
  447. struct w83781d_data *data = w83781d_update_device(dev);
  448. int bitnr = to_sensor_dev_attr(attr)->index;
  449. return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
  450. }
  451. static ssize_t
  452. store_beep(struct device *dev, struct device_attribute *attr,
  453. const char *buf, size_t count)
  454. {
  455. struct w83781d_data *data = dev_get_drvdata(dev);
  456. int bitnr = to_sensor_dev_attr(attr)->index;
  457. u8 reg;
  458. unsigned long bit;
  459. int err;
  460. err = kstrtoul(buf, 10, &bit);
  461. if (err)
  462. return err;
  463. if (bit & ~1)
  464. return -EINVAL;
  465. mutex_lock(&data->update_lock);
  466. if (bit)
  467. data->beep_mask |= (1 << bitnr);
  468. else
  469. data->beep_mask &= ~(1 << bitnr);
  470. if (bitnr < 8) {
  471. reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS1);
  472. if (bit)
  473. reg |= (1 << bitnr);
  474. else
  475. reg &= ~(1 << bitnr);
  476. w83781d_write_value(data, W83781D_REG_BEEP_INTS1, reg);
  477. } else if (bitnr < 16) {
  478. reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS2);
  479. if (bit)
  480. reg |= (1 << (bitnr - 8));
  481. else
  482. reg &= ~(1 << (bitnr - 8));
  483. w83781d_write_value(data, W83781D_REG_BEEP_INTS2, reg);
  484. } else {
  485. reg = w83781d_read_value(data, W83781D_REG_BEEP_INTS3);
  486. if (bit)
  487. reg |= (1 << (bitnr - 16));
  488. else
  489. reg &= ~(1 << (bitnr - 16));
  490. w83781d_write_value(data, W83781D_REG_BEEP_INTS3, reg);
  491. }
  492. mutex_unlock(&data->update_lock);
  493. return count;
  494. }
  495. /* The W83781D has a single beep bit for temp2 and temp3 */
  496. static ssize_t show_temp3_beep(struct device *dev,
  497. struct device_attribute *attr, char *buf)
  498. {
  499. struct w83781d_data *data = w83781d_update_device(dev);
  500. int bitnr = (data->type == w83781d) ? 5 : 13;
  501. return sprintf(buf, "%u\n", (data->beep_mask >> bitnr) & 1);
  502. }
  503. static SENSOR_DEVICE_ATTR(in0_beep, S_IRUGO | S_IWUSR,
  504. show_beep, store_beep, 0);
  505. static SENSOR_DEVICE_ATTR(in1_beep, S_IRUGO | S_IWUSR,
  506. show_beep, store_beep, 1);
  507. static SENSOR_DEVICE_ATTR(in2_beep, S_IRUGO | S_IWUSR,
  508. show_beep, store_beep, 2);
  509. static SENSOR_DEVICE_ATTR(in3_beep, S_IRUGO | S_IWUSR,
  510. show_beep, store_beep, 3);
  511. static SENSOR_DEVICE_ATTR(in4_beep, S_IRUGO | S_IWUSR,
  512. show_beep, store_beep, 8);
  513. static SENSOR_DEVICE_ATTR(in5_beep, S_IRUGO | S_IWUSR,
  514. show_beep, store_beep, 9);
  515. static SENSOR_DEVICE_ATTR(in6_beep, S_IRUGO | S_IWUSR,
  516. show_beep, store_beep, 10);
  517. static SENSOR_DEVICE_ATTR(in7_beep, S_IRUGO | S_IWUSR,
  518. show_beep, store_beep, 16);
  519. static SENSOR_DEVICE_ATTR(in8_beep, S_IRUGO | S_IWUSR,
  520. show_beep, store_beep, 17);
  521. static SENSOR_DEVICE_ATTR(fan1_beep, S_IRUGO | S_IWUSR,
  522. show_beep, store_beep, 6);
  523. static SENSOR_DEVICE_ATTR(fan2_beep, S_IRUGO | S_IWUSR,
  524. show_beep, store_beep, 7);
  525. static SENSOR_DEVICE_ATTR(fan3_beep, S_IRUGO | S_IWUSR,
  526. show_beep, store_beep, 11);
  527. static SENSOR_DEVICE_ATTR(temp1_beep, S_IRUGO | S_IWUSR,
  528. show_beep, store_beep, 4);
  529. static SENSOR_DEVICE_ATTR(temp2_beep, S_IRUGO | S_IWUSR,
  530. show_beep, store_beep, 5);
  531. static SENSOR_DEVICE_ATTR(temp3_beep, S_IRUGO,
  532. show_temp3_beep, store_beep, 13);
  533. static SENSOR_DEVICE_ATTR(beep_enable, S_IRUGO | S_IWUSR,
  534. show_beep, store_beep, 15);
  535. static ssize_t
  536. show_fan_div(struct device *dev, struct device_attribute *da, char *buf)
  537. {
  538. struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
  539. struct w83781d_data *data = w83781d_update_device(dev);
  540. return sprintf(buf, "%ld\n",
  541. (long) DIV_FROM_REG(data->fan_div[attr->index]));
  542. }
  543. /*
  544. * Note: we save and restore the fan minimum here, because its value is
  545. * determined in part by the fan divisor. This follows the principle of
  546. * least surprise; the user doesn't expect the fan minimum to change just
  547. * because the divisor changed.
  548. */
  549. static ssize_t
  550. store_fan_div(struct device *dev, struct device_attribute *da,
  551. const char *buf, size_t count)
  552. {
  553. struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
  554. struct w83781d_data *data = dev_get_drvdata(dev);
  555. unsigned long min;
  556. int nr = attr->index;
  557. u8 reg;
  558. unsigned long val;
  559. int err;
  560. err = kstrtoul(buf, 10, &val);
  561. if (err)
  562. return err;
  563. mutex_lock(&data->update_lock);
  564. /* Save fan_min */
  565. min = FAN_FROM_REG(data->fan_min[nr],
  566. DIV_FROM_REG(data->fan_div[nr]));
  567. data->fan_div[nr] = DIV_TO_REG(val, data->type);
  568. reg = (w83781d_read_value(data, nr == 2 ?
  569. W83781D_REG_PIN : W83781D_REG_VID_FANDIV)
  570. & (nr == 0 ? 0xcf : 0x3f))
  571. | ((data->fan_div[nr] & 0x03) << (nr == 0 ? 4 : 6));
  572. w83781d_write_value(data, nr == 2 ?
  573. W83781D_REG_PIN : W83781D_REG_VID_FANDIV, reg);
  574. /* w83781d and as99127f don't have extended divisor bits */
  575. if (data->type != w83781d && data->type != as99127f) {
  576. reg = (w83781d_read_value(data, W83781D_REG_VBAT)
  577. & ~(1 << (5 + nr)))
  578. | ((data->fan_div[nr] & 0x04) << (3 + nr));
  579. w83781d_write_value(data, W83781D_REG_VBAT, reg);
  580. }
  581. /* Restore fan_min */
  582. data->fan_min[nr] = FAN_TO_REG(min, DIV_FROM_REG(data->fan_div[nr]));
  583. w83781d_write_value(data, W83781D_REG_FAN_MIN(nr), data->fan_min[nr]);
  584. mutex_unlock(&data->update_lock);
  585. return count;
  586. }
  587. static SENSOR_DEVICE_ATTR(fan1_div, S_IRUGO | S_IWUSR,
  588. show_fan_div, store_fan_div, 0);
  589. static SENSOR_DEVICE_ATTR(fan2_div, S_IRUGO | S_IWUSR,
  590. show_fan_div, store_fan_div, 1);
  591. static SENSOR_DEVICE_ATTR(fan3_div, S_IRUGO | S_IWUSR,
  592. show_fan_div, store_fan_div, 2);
  593. static ssize_t
  594. show_pwm(struct device *dev, struct device_attribute *da, char *buf)
  595. {
  596. struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
  597. struct w83781d_data *data = w83781d_update_device(dev);
  598. return sprintf(buf, "%d\n", (int)data->pwm[attr->index]);
  599. }
  600. static ssize_t
  601. pwm2_enable_show(struct device *dev, struct device_attribute *da, char *buf)
  602. {
  603. struct w83781d_data *data = w83781d_update_device(dev);
  604. return sprintf(buf, "%d\n", (int)data->pwm2_enable);
  605. }
  606. static ssize_t
  607. store_pwm(struct device *dev, struct device_attribute *da, const char *buf,
  608. size_t count)
  609. {
  610. struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
  611. struct w83781d_data *data = dev_get_drvdata(dev);
  612. int nr = attr->index;
  613. unsigned long val;
  614. int err;
  615. err = kstrtoul(buf, 10, &val);
  616. if (err)
  617. return err;
  618. mutex_lock(&data->update_lock);
  619. data->pwm[nr] = clamp_val(val, 0, 255);
  620. w83781d_write_value(data, W83781D_REG_PWM[nr], data->pwm[nr]);
  621. mutex_unlock(&data->update_lock);
  622. return count;
  623. }
  624. static ssize_t
  625. pwm2_enable_store(struct device *dev, struct device_attribute *da,
  626. const char *buf, size_t count)
  627. {
  628. struct w83781d_data *data = dev_get_drvdata(dev);
  629. unsigned long val;
  630. u32 reg;
  631. int err;
  632. err = kstrtoul(buf, 10, &val);
  633. if (err)
  634. return err;
  635. mutex_lock(&data->update_lock);
  636. switch (val) {
  637. case 0:
  638. case 1:
  639. reg = w83781d_read_value(data, W83781D_REG_PWMCLK12);
  640. w83781d_write_value(data, W83781D_REG_PWMCLK12,
  641. (reg & 0xf7) | (val << 3));
  642. reg = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
  643. w83781d_write_value(data, W83781D_REG_BEEP_CONFIG,
  644. (reg & 0xef) | (!val << 4));
  645. data->pwm2_enable = val;
  646. break;
  647. default:
  648. mutex_unlock(&data->update_lock);
  649. return -EINVAL;
  650. }
  651. mutex_unlock(&data->update_lock);
  652. return count;
  653. }
  654. static SENSOR_DEVICE_ATTR(pwm1, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 0);
  655. static SENSOR_DEVICE_ATTR(pwm2, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 1);
  656. static SENSOR_DEVICE_ATTR(pwm3, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 2);
  657. static SENSOR_DEVICE_ATTR(pwm4, S_IRUGO | S_IWUSR, show_pwm, store_pwm, 3);
  658. /* only PWM2 can be enabled/disabled */
  659. static DEVICE_ATTR_RW(pwm2_enable);
  660. static ssize_t
  661. show_sensor(struct device *dev, struct device_attribute *da, char *buf)
  662. {
  663. struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
  664. struct w83781d_data *data = w83781d_update_device(dev);
  665. return sprintf(buf, "%d\n", (int)data->sens[attr->index]);
  666. }
  667. static ssize_t
  668. store_sensor(struct device *dev, struct device_attribute *da,
  669. const char *buf, size_t count)
  670. {
  671. struct sensor_device_attribute *attr = to_sensor_dev_attr(da);
  672. struct w83781d_data *data = dev_get_drvdata(dev);
  673. int nr = attr->index;
  674. unsigned long val;
  675. u32 tmp;
  676. int err;
  677. err = kstrtoul(buf, 10, &val);
  678. if (err)
  679. return err;
  680. mutex_lock(&data->update_lock);
  681. switch (val) {
  682. case 1: /* PII/Celeron diode */
  683. tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
  684. w83781d_write_value(data, W83781D_REG_SCFG1,
  685. tmp | BIT_SCFG1[nr]);
  686. tmp = w83781d_read_value(data, W83781D_REG_SCFG2);
  687. w83781d_write_value(data, W83781D_REG_SCFG2,
  688. tmp | BIT_SCFG2[nr]);
  689. data->sens[nr] = val;
  690. break;
  691. case 2: /* 3904 */
  692. tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
  693. w83781d_write_value(data, W83781D_REG_SCFG1,
  694. tmp | BIT_SCFG1[nr]);
  695. tmp = w83781d_read_value(data, W83781D_REG_SCFG2);
  696. w83781d_write_value(data, W83781D_REG_SCFG2,
  697. tmp & ~BIT_SCFG2[nr]);
  698. data->sens[nr] = val;
  699. break;
  700. case W83781D_DEFAULT_BETA:
  701. dev_warn(dev,
  702. "Sensor type %d is deprecated, please use 4 instead\n",
  703. W83781D_DEFAULT_BETA);
  704. fallthrough;
  705. case 4: /* thermistor */
  706. tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
  707. w83781d_write_value(data, W83781D_REG_SCFG1,
  708. tmp & ~BIT_SCFG1[nr]);
  709. data->sens[nr] = val;
  710. break;
  711. default:
  712. dev_err(dev, "Invalid sensor type %ld; must be 1, 2, or 4\n",
  713. (long) val);
  714. break;
  715. }
  716. mutex_unlock(&data->update_lock);
  717. return count;
  718. }
  719. static SENSOR_DEVICE_ATTR(temp1_type, S_IRUGO | S_IWUSR,
  720. show_sensor, store_sensor, 0);
  721. static SENSOR_DEVICE_ATTR(temp2_type, S_IRUGO | S_IWUSR,
  722. show_sensor, store_sensor, 1);
  723. static SENSOR_DEVICE_ATTR(temp3_type, S_IRUGO | S_IWUSR,
  724. show_sensor, store_sensor, 2);
  725. /*
  726. * Assumes that adapter is of I2C, not ISA variety.
  727. * OTHERWISE DON'T CALL THIS
  728. */
  729. static int
  730. w83781d_detect_subclients(struct i2c_client *new_client)
  731. {
  732. int i, val1 = 0, id;
  733. int err;
  734. int address = new_client->addr;
  735. unsigned short sc_addr[2];
  736. struct i2c_adapter *adapter = new_client->adapter;
  737. struct w83781d_data *data = i2c_get_clientdata(new_client);
  738. enum chips kind = data->type;
  739. int num_sc = 1;
  740. id = i2c_adapter_id(adapter);
  741. if (force_subclients[0] == id && force_subclients[1] == address) {
  742. for (i = 2; i <= 3; i++) {
  743. if (force_subclients[i] < 0x48 ||
  744. force_subclients[i] > 0x4f) {
  745. dev_err(&new_client->dev,
  746. "Invalid subclient address %d; must be 0x48-0x4f\n",
  747. force_subclients[i]);
  748. err = -EINVAL;
  749. goto ERROR_SC_1;
  750. }
  751. }
  752. w83781d_write_value(data, W83781D_REG_I2C_SUBADDR,
  753. (force_subclients[2] & 0x07) |
  754. ((force_subclients[3] & 0x07) << 4));
  755. sc_addr[0] = force_subclients[2];
  756. } else {
  757. val1 = w83781d_read_value(data, W83781D_REG_I2C_SUBADDR);
  758. sc_addr[0] = 0x48 + (val1 & 0x07);
  759. }
  760. if (kind != w83783s) {
  761. num_sc = 2;
  762. if (force_subclients[0] == id &&
  763. force_subclients[1] == address) {
  764. sc_addr[1] = force_subclients[3];
  765. } else {
  766. sc_addr[1] = 0x48 + ((val1 >> 4) & 0x07);
  767. }
  768. if (sc_addr[0] == sc_addr[1]) {
  769. dev_err(&new_client->dev,
  770. "Duplicate addresses 0x%x for subclients.\n",
  771. sc_addr[0]);
  772. err = -EBUSY;
  773. goto ERROR_SC_2;
  774. }
  775. }
  776. for (i = 0; i < num_sc; i++) {
  777. data->lm75[i] = i2c_new_dummy_device(adapter, sc_addr[i]);
  778. if (IS_ERR(data->lm75[i])) {
  779. dev_err(&new_client->dev,
  780. "Subclient %d registration at address 0x%x failed.\n",
  781. i, sc_addr[i]);
  782. err = PTR_ERR(data->lm75[i]);
  783. if (i == 1)
  784. goto ERROR_SC_3;
  785. goto ERROR_SC_2;
  786. }
  787. }
  788. return 0;
  789. /* Undo inits in case of errors */
  790. ERROR_SC_3:
  791. i2c_unregister_device(data->lm75[0]);
  792. ERROR_SC_2:
  793. ERROR_SC_1:
  794. return err;
  795. }
  796. #define IN_UNIT_ATTRS(X) \
  797. &sensor_dev_attr_in##X##_input.dev_attr.attr, \
  798. &sensor_dev_attr_in##X##_min.dev_attr.attr, \
  799. &sensor_dev_attr_in##X##_max.dev_attr.attr, \
  800. &sensor_dev_attr_in##X##_alarm.dev_attr.attr, \
  801. &sensor_dev_attr_in##X##_beep.dev_attr.attr
  802. #define FAN_UNIT_ATTRS(X) \
  803. &sensor_dev_attr_fan##X##_input.dev_attr.attr, \
  804. &sensor_dev_attr_fan##X##_min.dev_attr.attr, \
  805. &sensor_dev_attr_fan##X##_div.dev_attr.attr, \
  806. &sensor_dev_attr_fan##X##_alarm.dev_attr.attr, \
  807. &sensor_dev_attr_fan##X##_beep.dev_attr.attr
  808. #define TEMP_UNIT_ATTRS(X) \
  809. &sensor_dev_attr_temp##X##_input.dev_attr.attr, \
  810. &sensor_dev_attr_temp##X##_max.dev_attr.attr, \
  811. &sensor_dev_attr_temp##X##_max_hyst.dev_attr.attr, \
  812. &sensor_dev_attr_temp##X##_alarm.dev_attr.attr, \
  813. &sensor_dev_attr_temp##X##_beep.dev_attr.attr
  814. static struct attribute *w83781d_attributes[] = {
  815. IN_UNIT_ATTRS(0),
  816. IN_UNIT_ATTRS(2),
  817. IN_UNIT_ATTRS(3),
  818. IN_UNIT_ATTRS(4),
  819. IN_UNIT_ATTRS(5),
  820. IN_UNIT_ATTRS(6),
  821. FAN_UNIT_ATTRS(1),
  822. FAN_UNIT_ATTRS(2),
  823. FAN_UNIT_ATTRS(3),
  824. TEMP_UNIT_ATTRS(1),
  825. TEMP_UNIT_ATTRS(2),
  826. &dev_attr_cpu0_vid.attr,
  827. &dev_attr_vrm.attr,
  828. &dev_attr_alarms.attr,
  829. &dev_attr_beep_mask.attr,
  830. &sensor_dev_attr_beep_enable.dev_attr.attr,
  831. NULL
  832. };
  833. static const struct attribute_group w83781d_group = {
  834. .attrs = w83781d_attributes,
  835. };
  836. static struct attribute *w83781d_attributes_in1[] = {
  837. IN_UNIT_ATTRS(1),
  838. NULL
  839. };
  840. static const struct attribute_group w83781d_group_in1 = {
  841. .attrs = w83781d_attributes_in1,
  842. };
  843. static struct attribute *w83781d_attributes_in78[] = {
  844. IN_UNIT_ATTRS(7),
  845. IN_UNIT_ATTRS(8),
  846. NULL
  847. };
  848. static const struct attribute_group w83781d_group_in78 = {
  849. .attrs = w83781d_attributes_in78,
  850. };
  851. static struct attribute *w83781d_attributes_temp3[] = {
  852. TEMP_UNIT_ATTRS(3),
  853. NULL
  854. };
  855. static const struct attribute_group w83781d_group_temp3 = {
  856. .attrs = w83781d_attributes_temp3,
  857. };
  858. static struct attribute *w83781d_attributes_pwm12[] = {
  859. &sensor_dev_attr_pwm1.dev_attr.attr,
  860. &sensor_dev_attr_pwm2.dev_attr.attr,
  861. &dev_attr_pwm2_enable.attr,
  862. NULL
  863. };
  864. static const struct attribute_group w83781d_group_pwm12 = {
  865. .attrs = w83781d_attributes_pwm12,
  866. };
  867. static struct attribute *w83781d_attributes_pwm34[] = {
  868. &sensor_dev_attr_pwm3.dev_attr.attr,
  869. &sensor_dev_attr_pwm4.dev_attr.attr,
  870. NULL
  871. };
  872. static const struct attribute_group w83781d_group_pwm34 = {
  873. .attrs = w83781d_attributes_pwm34,
  874. };
  875. static struct attribute *w83781d_attributes_other[] = {
  876. &sensor_dev_attr_temp1_type.dev_attr.attr,
  877. &sensor_dev_attr_temp2_type.dev_attr.attr,
  878. &sensor_dev_attr_temp3_type.dev_attr.attr,
  879. NULL
  880. };
  881. static const struct attribute_group w83781d_group_other = {
  882. .attrs = w83781d_attributes_other,
  883. };
  884. /* No clean up is done on error, it's up to the caller */
  885. static int
  886. w83781d_create_files(struct device *dev, int kind, int is_isa)
  887. {
  888. int err;
  889. err = sysfs_create_group(&dev->kobj, &w83781d_group);
  890. if (err)
  891. return err;
  892. if (kind != w83783s) {
  893. err = sysfs_create_group(&dev->kobj, &w83781d_group_in1);
  894. if (err)
  895. return err;
  896. }
  897. if (kind != as99127f && kind != w83781d && kind != w83783s) {
  898. err = sysfs_create_group(&dev->kobj, &w83781d_group_in78);
  899. if (err)
  900. return err;
  901. }
  902. if (kind != w83783s) {
  903. err = sysfs_create_group(&dev->kobj, &w83781d_group_temp3);
  904. if (err)
  905. return err;
  906. if (kind != w83781d) {
  907. err = sysfs_chmod_file(&dev->kobj,
  908. &sensor_dev_attr_temp3_alarm.dev_attr.attr,
  909. S_IRUGO | S_IWUSR);
  910. if (err)
  911. return err;
  912. }
  913. }
  914. if (kind != w83781d && kind != as99127f) {
  915. err = sysfs_create_group(&dev->kobj, &w83781d_group_pwm12);
  916. if (err)
  917. return err;
  918. }
  919. if (kind == w83782d && !is_isa) {
  920. err = sysfs_create_group(&dev->kobj, &w83781d_group_pwm34);
  921. if (err)
  922. return err;
  923. }
  924. if (kind != as99127f && kind != w83781d) {
  925. err = device_create_file(dev,
  926. &sensor_dev_attr_temp1_type.dev_attr);
  927. if (err)
  928. return err;
  929. err = device_create_file(dev,
  930. &sensor_dev_attr_temp2_type.dev_attr);
  931. if (err)
  932. return err;
  933. if (kind != w83783s) {
  934. err = device_create_file(dev,
  935. &sensor_dev_attr_temp3_type.dev_attr);
  936. if (err)
  937. return err;
  938. }
  939. }
  940. return 0;
  941. }
  942. /* Return 0 if detection is successful, -ENODEV otherwise */
  943. static int
  944. w83781d_detect(struct i2c_client *client, struct i2c_board_info *info)
  945. {
  946. int val1, val2;
  947. struct w83781d_data *isa = w83781d_data_if_isa();
  948. struct i2c_adapter *adapter = client->adapter;
  949. int address = client->addr;
  950. const char *client_name;
  951. enum vendor { winbond, asus } vendid;
  952. if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
  953. return -ENODEV;
  954. /*
  955. * We block updates of the ISA device to minimize the risk of
  956. * concurrent access to the same W83781D chip through different
  957. * interfaces.
  958. */
  959. if (isa)
  960. mutex_lock(&isa->update_lock);
  961. if (i2c_smbus_read_byte_data(client, W83781D_REG_CONFIG) & 0x80) {
  962. dev_dbg(&adapter->dev,
  963. "Detection of w83781d chip failed at step 3\n");
  964. goto err_nodev;
  965. }
  966. val1 = i2c_smbus_read_byte_data(client, W83781D_REG_BANK);
  967. val2 = i2c_smbus_read_byte_data(client, W83781D_REG_CHIPMAN);
  968. /* Check for Winbond or Asus ID if in bank 0 */
  969. if (!(val1 & 0x07) &&
  970. ((!(val1 & 0x80) && val2 != 0xa3 && val2 != 0xc3) ||
  971. ((val1 & 0x80) && val2 != 0x5c && val2 != 0x12))) {
  972. dev_dbg(&adapter->dev,
  973. "Detection of w83781d chip failed at step 4\n");
  974. goto err_nodev;
  975. }
  976. /*
  977. * If Winbond SMBus, check address at 0x48.
  978. * Asus doesn't support, except for as99127f rev.2
  979. */
  980. if ((!(val1 & 0x80) && val2 == 0xa3) ||
  981. ((val1 & 0x80) && val2 == 0x5c)) {
  982. if (i2c_smbus_read_byte_data(client, W83781D_REG_I2C_ADDR)
  983. != address) {
  984. dev_dbg(&adapter->dev,
  985. "Detection of w83781d chip failed at step 5\n");
  986. goto err_nodev;
  987. }
  988. }
  989. /* Put it now into bank 0 and Vendor ID High Byte */
  990. i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
  991. (i2c_smbus_read_byte_data(client, W83781D_REG_BANK)
  992. & 0x78) | 0x80);
  993. /* Get the vendor ID */
  994. val2 = i2c_smbus_read_byte_data(client, W83781D_REG_CHIPMAN);
  995. if (val2 == 0x5c)
  996. vendid = winbond;
  997. else if (val2 == 0x12)
  998. vendid = asus;
  999. else {
  1000. dev_dbg(&adapter->dev,
  1001. "w83781d chip vendor is neither Winbond nor Asus\n");
  1002. goto err_nodev;
  1003. }
  1004. /* Determine the chip type. */
  1005. val1 = i2c_smbus_read_byte_data(client, W83781D_REG_WCHIPID);
  1006. if ((val1 == 0x10 || val1 == 0x11) && vendid == winbond)
  1007. client_name = "w83781d";
  1008. else if (val1 == 0x30 && vendid == winbond)
  1009. client_name = "w83782d";
  1010. else if (val1 == 0x40 && vendid == winbond && address == 0x2d)
  1011. client_name = "w83783s";
  1012. else if (val1 == 0x31)
  1013. client_name = "as99127f";
  1014. else
  1015. goto err_nodev;
  1016. if (val1 <= 0x30 && w83781d_alias_detect(client, val1)) {
  1017. dev_dbg(&adapter->dev,
  1018. "Device at 0x%02x appears to be the same as ISA device\n",
  1019. address);
  1020. goto err_nodev;
  1021. }
  1022. if (isa)
  1023. mutex_unlock(&isa->update_lock);
  1024. strscpy(info->type, client_name, I2C_NAME_SIZE);
  1025. return 0;
  1026. err_nodev:
  1027. if (isa)
  1028. mutex_unlock(&isa->update_lock);
  1029. return -ENODEV;
  1030. }
  1031. static void w83781d_remove_files(struct device *dev)
  1032. {
  1033. sysfs_remove_group(&dev->kobj, &w83781d_group);
  1034. sysfs_remove_group(&dev->kobj, &w83781d_group_in1);
  1035. sysfs_remove_group(&dev->kobj, &w83781d_group_in78);
  1036. sysfs_remove_group(&dev->kobj, &w83781d_group_temp3);
  1037. sysfs_remove_group(&dev->kobj, &w83781d_group_pwm12);
  1038. sysfs_remove_group(&dev->kobj, &w83781d_group_pwm34);
  1039. sysfs_remove_group(&dev->kobj, &w83781d_group_other);
  1040. }
  1041. static int w83781d_probe(struct i2c_client *client)
  1042. {
  1043. struct device *dev = &client->dev;
  1044. struct w83781d_data *data;
  1045. int err;
  1046. data = devm_kzalloc(dev, sizeof(struct w83781d_data), GFP_KERNEL);
  1047. if (!data)
  1048. return -ENOMEM;
  1049. i2c_set_clientdata(client, data);
  1050. mutex_init(&data->lock);
  1051. mutex_init(&data->update_lock);
  1052. data->type = (uintptr_t)i2c_get_match_data(client);
  1053. data->client = client;
  1054. /* attach secondary i2c lm75-like clients */
  1055. err = w83781d_detect_subclients(client);
  1056. if (err)
  1057. return err;
  1058. /* Initialize the chip */
  1059. w83781d_init_device(dev);
  1060. /* Register sysfs hooks */
  1061. err = w83781d_create_files(dev, data->type, 0);
  1062. if (err)
  1063. goto exit_remove_files;
  1064. data->hwmon_dev = hwmon_device_register(dev);
  1065. if (IS_ERR(data->hwmon_dev)) {
  1066. err = PTR_ERR(data->hwmon_dev);
  1067. goto exit_remove_files;
  1068. }
  1069. return 0;
  1070. exit_remove_files:
  1071. w83781d_remove_files(dev);
  1072. i2c_unregister_device(data->lm75[0]);
  1073. i2c_unregister_device(data->lm75[1]);
  1074. return err;
  1075. }
  1076. static void
  1077. w83781d_remove(struct i2c_client *client)
  1078. {
  1079. struct w83781d_data *data = i2c_get_clientdata(client);
  1080. struct device *dev = &client->dev;
  1081. hwmon_device_unregister(data->hwmon_dev);
  1082. w83781d_remove_files(dev);
  1083. i2c_unregister_device(data->lm75[0]);
  1084. i2c_unregister_device(data->lm75[1]);
  1085. }
  1086. static int
  1087. w83781d_read_value_i2c(struct w83781d_data *data, u16 reg)
  1088. {
  1089. struct i2c_client *client = data->client;
  1090. int res, bank;
  1091. struct i2c_client *cl;
  1092. bank = (reg >> 8) & 0x0f;
  1093. if (bank > 2)
  1094. /* switch banks */
  1095. i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
  1096. bank);
  1097. if (bank == 0 || bank > 2) {
  1098. res = i2c_smbus_read_byte_data(client, reg & 0xff);
  1099. } else {
  1100. /* switch to subclient */
  1101. cl = data->lm75[bank - 1];
  1102. /* convert from ISA to LM75 I2C addresses */
  1103. switch (reg & 0xff) {
  1104. case 0x50: /* TEMP */
  1105. res = i2c_smbus_read_word_swapped(cl, 0);
  1106. break;
  1107. case 0x52: /* CONFIG */
  1108. res = i2c_smbus_read_byte_data(cl, 1);
  1109. break;
  1110. case 0x53: /* HYST */
  1111. res = i2c_smbus_read_word_swapped(cl, 2);
  1112. break;
  1113. case 0x55: /* OVER */
  1114. default:
  1115. res = i2c_smbus_read_word_swapped(cl, 3);
  1116. break;
  1117. }
  1118. }
  1119. if (bank > 2)
  1120. i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0);
  1121. return res;
  1122. }
  1123. static int
  1124. w83781d_write_value_i2c(struct w83781d_data *data, u16 reg, u16 value)
  1125. {
  1126. struct i2c_client *client = data->client;
  1127. int bank;
  1128. struct i2c_client *cl;
  1129. bank = (reg >> 8) & 0x0f;
  1130. if (bank > 2)
  1131. /* switch banks */
  1132. i2c_smbus_write_byte_data(client, W83781D_REG_BANK,
  1133. bank);
  1134. if (bank == 0 || bank > 2) {
  1135. i2c_smbus_write_byte_data(client, reg & 0xff,
  1136. value & 0xff);
  1137. } else {
  1138. /* switch to subclient */
  1139. cl = data->lm75[bank - 1];
  1140. /* convert from ISA to LM75 I2C addresses */
  1141. switch (reg & 0xff) {
  1142. case 0x52: /* CONFIG */
  1143. i2c_smbus_write_byte_data(cl, 1, value & 0xff);
  1144. break;
  1145. case 0x53: /* HYST */
  1146. i2c_smbus_write_word_swapped(cl, 2, value);
  1147. break;
  1148. case 0x55: /* OVER */
  1149. i2c_smbus_write_word_swapped(cl, 3, value);
  1150. break;
  1151. }
  1152. }
  1153. if (bank > 2)
  1154. i2c_smbus_write_byte_data(client, W83781D_REG_BANK, 0);
  1155. return 0;
  1156. }
  1157. static void
  1158. w83781d_init_device(struct device *dev)
  1159. {
  1160. struct w83781d_data *data = dev_get_drvdata(dev);
  1161. int i, p;
  1162. int type = data->type;
  1163. u8 tmp;
  1164. if (reset && type != as99127f) { /*
  1165. * this resets registers we don't have
  1166. * documentation for on the as99127f
  1167. */
  1168. /*
  1169. * Resetting the chip has been the default for a long time,
  1170. * but it causes the BIOS initializations (fan clock dividers,
  1171. * thermal sensor types...) to be lost, so it is now optional.
  1172. * It might even go away if nobody reports it as being useful,
  1173. * as I see very little reason why this would be needed at
  1174. * all.
  1175. */
  1176. dev_info(dev,
  1177. "If reset=1 solved a problem you were having, please report!\n");
  1178. /* save these registers */
  1179. i = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
  1180. p = w83781d_read_value(data, W83781D_REG_PWMCLK12);
  1181. /*
  1182. * Reset all except Watchdog values and last conversion values
  1183. * This sets fan-divs to 2, among others
  1184. */
  1185. w83781d_write_value(data, W83781D_REG_CONFIG, 0x80);
  1186. /*
  1187. * Restore the registers and disable power-on abnormal beep.
  1188. * This saves FAN 1/2/3 input/output values set by BIOS.
  1189. */
  1190. w83781d_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
  1191. w83781d_write_value(data, W83781D_REG_PWMCLK12, p);
  1192. /*
  1193. * Disable master beep-enable (reset turns it on).
  1194. * Individual beep_mask should be reset to off but for some
  1195. * reason disabling this bit helps some people not get beeped
  1196. */
  1197. w83781d_write_value(data, W83781D_REG_BEEP_INTS2, 0);
  1198. }
  1199. /*
  1200. * Disable power-on abnormal beep, as advised by the datasheet.
  1201. * Already done if reset=1.
  1202. */
  1203. if (init && !reset && type != as99127f) {
  1204. i = w83781d_read_value(data, W83781D_REG_BEEP_CONFIG);
  1205. w83781d_write_value(data, W83781D_REG_BEEP_CONFIG, i | 0x80);
  1206. }
  1207. data->vrm = vid_which_vrm();
  1208. if ((type != w83781d) && (type != as99127f)) {
  1209. tmp = w83781d_read_value(data, W83781D_REG_SCFG1);
  1210. for (i = 1; i <= 3; i++) {
  1211. if (!(tmp & BIT_SCFG1[i - 1])) {
  1212. data->sens[i - 1] = 4;
  1213. } else {
  1214. if (w83781d_read_value
  1215. (data,
  1216. W83781D_REG_SCFG2) & BIT_SCFG2[i - 1])
  1217. data->sens[i - 1] = 1;
  1218. else
  1219. data->sens[i - 1] = 2;
  1220. }
  1221. if (type == w83783s && i == 2)
  1222. break;
  1223. }
  1224. }
  1225. if (init && type != as99127f) {
  1226. /* Enable temp2 */
  1227. tmp = w83781d_read_value(data, W83781D_REG_TEMP2_CONFIG);
  1228. if (tmp & 0x01) {
  1229. dev_warn(dev,
  1230. "Enabling temp2, readings might not make sense\n");
  1231. w83781d_write_value(data, W83781D_REG_TEMP2_CONFIG,
  1232. tmp & 0xfe);
  1233. }
  1234. /* Enable temp3 */
  1235. if (type != w83783s) {
  1236. tmp = w83781d_read_value(data,
  1237. W83781D_REG_TEMP3_CONFIG);
  1238. if (tmp & 0x01) {
  1239. dev_warn(dev,
  1240. "Enabling temp3, readings might not make sense\n");
  1241. w83781d_write_value(data,
  1242. W83781D_REG_TEMP3_CONFIG, tmp & 0xfe);
  1243. }
  1244. }
  1245. }
  1246. /* Start monitoring */
  1247. w83781d_write_value(data, W83781D_REG_CONFIG,
  1248. (w83781d_read_value(data,
  1249. W83781D_REG_CONFIG) & 0xf7)
  1250. | 0x01);
  1251. /* A few vars need to be filled upon startup */
  1252. for (i = 0; i < 3; i++) {
  1253. data->fan_min[i] = w83781d_read_value(data,
  1254. W83781D_REG_FAN_MIN(i));
  1255. }
  1256. mutex_init(&data->update_lock);
  1257. }
  1258. static struct w83781d_data *w83781d_update_device(struct device *dev)
  1259. {
  1260. struct w83781d_data *data = dev_get_drvdata(dev);
  1261. struct i2c_client *client = data->client;
  1262. int i;
  1263. mutex_lock(&data->update_lock);
  1264. if (time_after(jiffies, data->last_updated + HZ + HZ / 2)
  1265. || !data->valid) {
  1266. dev_dbg(dev, "Starting device update\n");
  1267. for (i = 0; i <= 8; i++) {
  1268. if (data->type == w83783s && i == 1)
  1269. continue; /* 783S has no in1 */
  1270. data->in[i] =
  1271. w83781d_read_value(data, W83781D_REG_IN(i));
  1272. data->in_min[i] =
  1273. w83781d_read_value(data, W83781D_REG_IN_MIN(i));
  1274. data->in_max[i] =
  1275. w83781d_read_value(data, W83781D_REG_IN_MAX(i));
  1276. if ((data->type != w83782d) && (i == 6))
  1277. break;
  1278. }
  1279. for (i = 0; i < 3; i++) {
  1280. data->fan[i] =
  1281. w83781d_read_value(data, W83781D_REG_FAN(i));
  1282. data->fan_min[i] =
  1283. w83781d_read_value(data, W83781D_REG_FAN_MIN(i));
  1284. }
  1285. if (data->type != w83781d && data->type != as99127f) {
  1286. for (i = 0; i < 4; i++) {
  1287. data->pwm[i] =
  1288. w83781d_read_value(data,
  1289. W83781D_REG_PWM[i]);
  1290. /* Only W83782D on SMBus has PWM3 and PWM4 */
  1291. if ((data->type != w83782d || !client)
  1292. && i == 1)
  1293. break;
  1294. }
  1295. /* Only PWM2 can be disabled */
  1296. data->pwm2_enable = (w83781d_read_value(data,
  1297. W83781D_REG_PWMCLK12) & 0x08) >> 3;
  1298. }
  1299. data->temp = w83781d_read_value(data, W83781D_REG_TEMP(1));
  1300. data->temp_max =
  1301. w83781d_read_value(data, W83781D_REG_TEMP_OVER(1));
  1302. data->temp_max_hyst =
  1303. w83781d_read_value(data, W83781D_REG_TEMP_HYST(1));
  1304. data->temp_add[0] =
  1305. w83781d_read_value(data, W83781D_REG_TEMP(2));
  1306. data->temp_max_add[0] =
  1307. w83781d_read_value(data, W83781D_REG_TEMP_OVER(2));
  1308. data->temp_max_hyst_add[0] =
  1309. w83781d_read_value(data, W83781D_REG_TEMP_HYST(2));
  1310. if (data->type != w83783s) {
  1311. data->temp_add[1] =
  1312. w83781d_read_value(data, W83781D_REG_TEMP(3));
  1313. data->temp_max_add[1] =
  1314. w83781d_read_value(data,
  1315. W83781D_REG_TEMP_OVER(3));
  1316. data->temp_max_hyst_add[1] =
  1317. w83781d_read_value(data,
  1318. W83781D_REG_TEMP_HYST(3));
  1319. }
  1320. i = w83781d_read_value(data, W83781D_REG_VID_FANDIV);
  1321. data->vid = i & 0x0f;
  1322. data->vid |= (w83781d_read_value(data,
  1323. W83781D_REG_CHIPID) & 0x01) << 4;
  1324. data->fan_div[0] = (i >> 4) & 0x03;
  1325. data->fan_div[1] = (i >> 6) & 0x03;
  1326. data->fan_div[2] = (w83781d_read_value(data,
  1327. W83781D_REG_PIN) >> 6) & 0x03;
  1328. if ((data->type != w83781d) && (data->type != as99127f)) {
  1329. i = w83781d_read_value(data, W83781D_REG_VBAT);
  1330. data->fan_div[0] |= (i >> 3) & 0x04;
  1331. data->fan_div[1] |= (i >> 4) & 0x04;
  1332. data->fan_div[2] |= (i >> 5) & 0x04;
  1333. }
  1334. if (data->type == w83782d) {
  1335. data->alarms = w83781d_read_value(data,
  1336. W83782D_REG_ALARM1)
  1337. | (w83781d_read_value(data,
  1338. W83782D_REG_ALARM2) << 8)
  1339. | (w83781d_read_value(data,
  1340. W83782D_REG_ALARM3) << 16);
  1341. } else if (data->type == w83783s) {
  1342. data->alarms = w83781d_read_value(data,
  1343. W83782D_REG_ALARM1)
  1344. | (w83781d_read_value(data,
  1345. W83782D_REG_ALARM2) << 8);
  1346. } else {
  1347. /*
  1348. * No real-time status registers, fall back to
  1349. * interrupt status registers
  1350. */
  1351. data->alarms = w83781d_read_value(data,
  1352. W83781D_REG_ALARM1)
  1353. | (w83781d_read_value(data,
  1354. W83781D_REG_ALARM2) << 8);
  1355. }
  1356. i = w83781d_read_value(data, W83781D_REG_BEEP_INTS2);
  1357. data->beep_mask = (i << 8) +
  1358. w83781d_read_value(data, W83781D_REG_BEEP_INTS1);
  1359. if ((data->type != w83781d) && (data->type != as99127f)) {
  1360. data->beep_mask |=
  1361. w83781d_read_value(data,
  1362. W83781D_REG_BEEP_INTS3) << 16;
  1363. }
  1364. data->last_updated = jiffies;
  1365. data->valid = true;
  1366. }
  1367. mutex_unlock(&data->update_lock);
  1368. return data;
  1369. }
  1370. static const struct i2c_device_id w83781d_ids[] = {
  1371. { "w83781d", w83781d, },
  1372. { "w83782d", w83782d, },
  1373. { "w83783s", w83783s, },
  1374. { "as99127f", as99127f },
  1375. { /* LIST END */ }
  1376. };
  1377. MODULE_DEVICE_TABLE(i2c, w83781d_ids);
  1378. static const struct of_device_id w83781d_of_match[] = {
  1379. { .compatible = "winbond,w83781d" },
  1380. { .compatible = "winbond,w83781g" },
  1381. { .compatible = "winbond,w83782d" },
  1382. { .compatible = "winbond,w83783s" },
  1383. { .compatible = "asus,as99127f" },
  1384. { },
  1385. };
  1386. MODULE_DEVICE_TABLE(of, w83781d_of_match);
  1387. static struct i2c_driver w83781d_driver = {
  1388. .class = I2C_CLASS_HWMON,
  1389. .driver = {
  1390. .name = "w83781d",
  1391. .of_match_table = w83781d_of_match,
  1392. },
  1393. .probe = w83781d_probe,
  1394. .remove = w83781d_remove,
  1395. .id_table = w83781d_ids,
  1396. .detect = w83781d_detect,
  1397. .address_list = normal_i2c,
  1398. };
  1399. /*
  1400. * ISA related code
  1401. */
  1402. #ifdef CONFIG_ISA
  1403. /* ISA device, if found */
  1404. static struct platform_device *pdev;
  1405. static unsigned short isa_address = 0x290;
  1406. /*
  1407. * I2C devices get this name attribute automatically, but for ISA devices
  1408. * we must create it by ourselves.
  1409. */
  1410. static ssize_t
  1411. name_show(struct device *dev, struct device_attribute *devattr, char *buf)
  1412. {
  1413. struct w83781d_data *data = dev_get_drvdata(dev);
  1414. return sprintf(buf, "%s\n", data->name);
  1415. }
  1416. static DEVICE_ATTR_RO(name);
  1417. static struct w83781d_data *w83781d_data_if_isa(void)
  1418. {
  1419. return pdev ? platform_get_drvdata(pdev) : NULL;
  1420. }
  1421. /* Returns 1 if the I2C chip appears to be an alias of the ISA chip */
  1422. static int w83781d_alias_detect(struct i2c_client *client, u8 chipid)
  1423. {
  1424. struct w83781d_data *isa;
  1425. int i;
  1426. if (!pdev) /* No ISA chip */
  1427. return 0;
  1428. isa = platform_get_drvdata(pdev);
  1429. if (w83781d_read_value(isa, W83781D_REG_I2C_ADDR) != client->addr)
  1430. return 0; /* Address doesn't match */
  1431. if (w83781d_read_value(isa, W83781D_REG_WCHIPID) != chipid)
  1432. return 0; /* Chip type doesn't match */
  1433. /*
  1434. * We compare all the limit registers, the config register and the
  1435. * interrupt mask registers
  1436. */
  1437. for (i = 0x2b; i <= 0x3d; i++) {
  1438. if (w83781d_read_value(isa, i) !=
  1439. i2c_smbus_read_byte_data(client, i))
  1440. return 0;
  1441. }
  1442. if (w83781d_read_value(isa, W83781D_REG_CONFIG) !=
  1443. i2c_smbus_read_byte_data(client, W83781D_REG_CONFIG))
  1444. return 0;
  1445. for (i = 0x43; i <= 0x46; i++) {
  1446. if (w83781d_read_value(isa, i) !=
  1447. i2c_smbus_read_byte_data(client, i))
  1448. return 0;
  1449. }
  1450. return 1;
  1451. }
  1452. static int
  1453. w83781d_read_value_isa(struct w83781d_data *data, u16 reg)
  1454. {
  1455. int word_sized, res;
  1456. word_sized = (((reg & 0xff00) == 0x100)
  1457. || ((reg & 0xff00) == 0x200))
  1458. && (((reg & 0x00ff) == 0x50)
  1459. || ((reg & 0x00ff) == 0x53)
  1460. || ((reg & 0x00ff) == 0x55));
  1461. if (reg & 0xff00) {
  1462. outb_p(W83781D_REG_BANK,
  1463. data->isa_addr + W83781D_ADDR_REG_OFFSET);
  1464. outb_p(reg >> 8,
  1465. data->isa_addr + W83781D_DATA_REG_OFFSET);
  1466. }
  1467. outb_p(reg & 0xff, data->isa_addr + W83781D_ADDR_REG_OFFSET);
  1468. res = inb_p(data->isa_addr + W83781D_DATA_REG_OFFSET);
  1469. if (word_sized) {
  1470. outb_p((reg & 0xff) + 1,
  1471. data->isa_addr + W83781D_ADDR_REG_OFFSET);
  1472. res =
  1473. (res << 8) + inb_p(data->isa_addr +
  1474. W83781D_DATA_REG_OFFSET);
  1475. }
  1476. if (reg & 0xff00) {
  1477. outb_p(W83781D_REG_BANK,
  1478. data->isa_addr + W83781D_ADDR_REG_OFFSET);
  1479. outb_p(0, data->isa_addr + W83781D_DATA_REG_OFFSET);
  1480. }
  1481. return res;
  1482. }
  1483. static void
  1484. w83781d_write_value_isa(struct w83781d_data *data, u16 reg, u16 value)
  1485. {
  1486. int word_sized;
  1487. word_sized = (((reg & 0xff00) == 0x100)
  1488. || ((reg & 0xff00) == 0x200))
  1489. && (((reg & 0x00ff) == 0x53)
  1490. || ((reg & 0x00ff) == 0x55));
  1491. if (reg & 0xff00) {
  1492. outb_p(W83781D_REG_BANK,
  1493. data->isa_addr + W83781D_ADDR_REG_OFFSET);
  1494. outb_p(reg >> 8,
  1495. data->isa_addr + W83781D_DATA_REG_OFFSET);
  1496. }
  1497. outb_p(reg & 0xff, data->isa_addr + W83781D_ADDR_REG_OFFSET);
  1498. if (word_sized) {
  1499. outb_p(value >> 8,
  1500. data->isa_addr + W83781D_DATA_REG_OFFSET);
  1501. outb_p((reg & 0xff) + 1,
  1502. data->isa_addr + W83781D_ADDR_REG_OFFSET);
  1503. }
  1504. outb_p(value & 0xff, data->isa_addr + W83781D_DATA_REG_OFFSET);
  1505. if (reg & 0xff00) {
  1506. outb_p(W83781D_REG_BANK,
  1507. data->isa_addr + W83781D_ADDR_REG_OFFSET);
  1508. outb_p(0, data->isa_addr + W83781D_DATA_REG_OFFSET);
  1509. }
  1510. }
  1511. /*
  1512. * The SMBus locks itself, usually, but nothing may access the Winbond between
  1513. * bank switches. ISA access must always be locked explicitly!
  1514. * We ignore the W83781D BUSY flag at this moment - it could lead to deadlocks,
  1515. * would slow down the W83781D access and should not be necessary.
  1516. * There are some ugly typecasts here, but the good news is - they should
  1517. * nowhere else be necessary!
  1518. */
  1519. static int
  1520. w83781d_read_value(struct w83781d_data *data, u16 reg)
  1521. {
  1522. struct i2c_client *client = data->client;
  1523. int res;
  1524. mutex_lock(&data->lock);
  1525. if (client)
  1526. res = w83781d_read_value_i2c(data, reg);
  1527. else
  1528. res = w83781d_read_value_isa(data, reg);
  1529. mutex_unlock(&data->lock);
  1530. return res;
  1531. }
  1532. static int
  1533. w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value)
  1534. {
  1535. struct i2c_client *client = data->client;
  1536. mutex_lock(&data->lock);
  1537. if (client)
  1538. w83781d_write_value_i2c(data, reg, value);
  1539. else
  1540. w83781d_write_value_isa(data, reg, value);
  1541. mutex_unlock(&data->lock);
  1542. return 0;
  1543. }
  1544. static int
  1545. w83781d_isa_probe(struct platform_device *pdev)
  1546. {
  1547. int err, reg;
  1548. struct w83781d_data *data;
  1549. struct resource *res;
  1550. /* Reserve the ISA region */
  1551. res = platform_get_resource(pdev, IORESOURCE_IO, 0);
  1552. if (!devm_request_region(&pdev->dev,
  1553. res->start + W83781D_ADDR_REG_OFFSET, 2,
  1554. "w83781d"))
  1555. return -EBUSY;
  1556. data = devm_kzalloc(&pdev->dev, sizeof(struct w83781d_data),
  1557. GFP_KERNEL);
  1558. if (!data)
  1559. return -ENOMEM;
  1560. mutex_init(&data->lock);
  1561. data->isa_addr = res->start;
  1562. platform_set_drvdata(pdev, data);
  1563. reg = w83781d_read_value(data, W83781D_REG_WCHIPID);
  1564. switch (reg) {
  1565. case 0x30:
  1566. data->type = w83782d;
  1567. data->name = "w83782d";
  1568. break;
  1569. default:
  1570. data->type = w83781d;
  1571. data->name = "w83781d";
  1572. }
  1573. /* Initialize the W83781D chip */
  1574. w83781d_init_device(&pdev->dev);
  1575. /* Register sysfs hooks */
  1576. err = w83781d_create_files(&pdev->dev, data->type, 1);
  1577. if (err)
  1578. goto exit_remove_files;
  1579. err = device_create_file(&pdev->dev, &dev_attr_name);
  1580. if (err)
  1581. goto exit_remove_files;
  1582. data->hwmon_dev = hwmon_device_register(&pdev->dev);
  1583. if (IS_ERR(data->hwmon_dev)) {
  1584. err = PTR_ERR(data->hwmon_dev);
  1585. goto exit_remove_files;
  1586. }
  1587. return 0;
  1588. exit_remove_files:
  1589. w83781d_remove_files(&pdev->dev);
  1590. device_remove_file(&pdev->dev, &dev_attr_name);
  1591. return err;
  1592. }
  1593. static void w83781d_isa_remove(struct platform_device *pdev)
  1594. {
  1595. struct w83781d_data *data = platform_get_drvdata(pdev);
  1596. hwmon_device_unregister(data->hwmon_dev);
  1597. w83781d_remove_files(&pdev->dev);
  1598. device_remove_file(&pdev->dev, &dev_attr_name);
  1599. }
  1600. static struct platform_driver w83781d_isa_driver = {
  1601. .driver = {
  1602. .name = "w83781d",
  1603. },
  1604. .probe = w83781d_isa_probe,
  1605. .remove = w83781d_isa_remove,
  1606. };
  1607. /* return 1 if a supported chip is found, 0 otherwise */
  1608. static int __init
  1609. w83781d_isa_found(unsigned short address)
  1610. {
  1611. int val, save, found = 0;
  1612. int port;
  1613. /*
  1614. * Some boards declare base+0 to base+7 as a PNP device, some base+4
  1615. * to base+7 and some base+5 to base+6. So we better request each port
  1616. * individually for the probing phase.
  1617. */
  1618. for (port = address; port < address + W83781D_EXTENT; port++) {
  1619. if (!request_region(port, 1, "w83781d")) {
  1620. pr_debug("Failed to request port 0x%x\n", port);
  1621. goto release;
  1622. }
  1623. }
  1624. /*
  1625. * We need the timeouts for at least some W83781D-like
  1626. * chips. But only if we read 'undefined' registers.
  1627. * There used to be a "#define REALLY_SLOW_IO" to enforce that, but
  1628. * this has been without any effect since more than a decade, so it
  1629. * has been dropped.
  1630. */
  1631. val = inb_p(address + 1);
  1632. if (inb_p(address + 2) != val
  1633. || inb_p(address + 3) != val
  1634. || inb_p(address + 7) != val) {
  1635. pr_debug("Detection failed at step %d\n", 1);
  1636. goto release;
  1637. }
  1638. /*
  1639. * We should be able to change the 7 LSB of the address port. The
  1640. * MSB (busy flag) should be clear initially, set after the write.
  1641. */
  1642. save = inb_p(address + W83781D_ADDR_REG_OFFSET);
  1643. if (save & 0x80) {
  1644. pr_debug("Detection failed at step %d\n", 2);
  1645. goto release;
  1646. }
  1647. val = ~save & 0x7f;
  1648. outb_p(val, address + W83781D_ADDR_REG_OFFSET);
  1649. if (inb_p(address + W83781D_ADDR_REG_OFFSET) != (val | 0x80)) {
  1650. outb_p(save, address + W83781D_ADDR_REG_OFFSET);
  1651. pr_debug("Detection failed at step %d\n", 3);
  1652. goto release;
  1653. }
  1654. /* We found a device, now see if it could be a W83781D */
  1655. outb_p(W83781D_REG_CONFIG, address + W83781D_ADDR_REG_OFFSET);
  1656. val = inb_p(address + W83781D_DATA_REG_OFFSET);
  1657. if (val & 0x80) {
  1658. pr_debug("Detection failed at step %d\n", 4);
  1659. goto release;
  1660. }
  1661. outb_p(W83781D_REG_BANK, address + W83781D_ADDR_REG_OFFSET);
  1662. save = inb_p(address + W83781D_DATA_REG_OFFSET);
  1663. outb_p(W83781D_REG_CHIPMAN, address + W83781D_ADDR_REG_OFFSET);
  1664. val = inb_p(address + W83781D_DATA_REG_OFFSET);
  1665. if ((!(save & 0x80) && (val != 0xa3))
  1666. || ((save & 0x80) && (val != 0x5c))) {
  1667. pr_debug("Detection failed at step %d\n", 5);
  1668. goto release;
  1669. }
  1670. outb_p(W83781D_REG_I2C_ADDR, address + W83781D_ADDR_REG_OFFSET);
  1671. val = inb_p(address + W83781D_DATA_REG_OFFSET);
  1672. if (val < 0x03 || val > 0x77) { /* Not a valid I2C address */
  1673. pr_debug("Detection failed at step %d\n", 6);
  1674. goto release;
  1675. }
  1676. /* The busy flag should be clear again */
  1677. if (inb_p(address + W83781D_ADDR_REG_OFFSET) & 0x80) {
  1678. pr_debug("Detection failed at step %d\n", 7);
  1679. goto release;
  1680. }
  1681. /* Determine the chip type */
  1682. outb_p(W83781D_REG_BANK, address + W83781D_ADDR_REG_OFFSET);
  1683. save = inb_p(address + W83781D_DATA_REG_OFFSET);
  1684. outb_p(save & 0xf8, address + W83781D_DATA_REG_OFFSET);
  1685. outb_p(W83781D_REG_WCHIPID, address + W83781D_ADDR_REG_OFFSET);
  1686. val = inb_p(address + W83781D_DATA_REG_OFFSET);
  1687. if ((val & 0xfe) == 0x10 /* W83781D */
  1688. || val == 0x30) /* W83782D */
  1689. found = 1;
  1690. if (found)
  1691. pr_info("Found a %s chip at %#x\n",
  1692. val == 0x30 ? "W83782D" : "W83781D", (int)address);
  1693. release:
  1694. for (port--; port >= address; port--)
  1695. release_region(port, 1);
  1696. return found;
  1697. }
  1698. static int __init
  1699. w83781d_isa_device_add(unsigned short address)
  1700. {
  1701. struct resource res = {
  1702. .start = address,
  1703. .end = address + W83781D_EXTENT - 1,
  1704. .name = "w83781d",
  1705. .flags = IORESOURCE_IO,
  1706. };
  1707. int err;
  1708. pdev = platform_device_alloc("w83781d", address);
  1709. if (!pdev) {
  1710. err = -ENOMEM;
  1711. pr_err("Device allocation failed\n");
  1712. goto exit;
  1713. }
  1714. err = platform_device_add_resources(pdev, &res, 1);
  1715. if (err) {
  1716. pr_err("Device resource addition failed (%d)\n", err);
  1717. goto exit_device_put;
  1718. }
  1719. err = platform_device_add(pdev);
  1720. if (err) {
  1721. pr_err("Device addition failed (%d)\n", err);
  1722. goto exit_device_put;
  1723. }
  1724. return 0;
  1725. exit_device_put:
  1726. platform_device_put(pdev);
  1727. exit:
  1728. pdev = NULL;
  1729. return err;
  1730. }
  1731. static int __init
  1732. w83781d_isa_register(void)
  1733. {
  1734. int res;
  1735. if (w83781d_isa_found(isa_address)) {
  1736. res = platform_driver_register(&w83781d_isa_driver);
  1737. if (res)
  1738. goto exit;
  1739. /* Sets global pdev as a side effect */
  1740. res = w83781d_isa_device_add(isa_address);
  1741. if (res)
  1742. goto exit_unreg_isa_driver;
  1743. }
  1744. return 0;
  1745. exit_unreg_isa_driver:
  1746. platform_driver_unregister(&w83781d_isa_driver);
  1747. exit:
  1748. return res;
  1749. }
  1750. static void
  1751. w83781d_isa_unregister(void)
  1752. {
  1753. if (pdev) {
  1754. platform_device_unregister(pdev);
  1755. platform_driver_unregister(&w83781d_isa_driver);
  1756. }
  1757. }
  1758. #else /* !CONFIG_ISA */
  1759. static struct w83781d_data *w83781d_data_if_isa(void)
  1760. {
  1761. return NULL;
  1762. }
  1763. static int
  1764. w83781d_alias_detect(struct i2c_client *client, u8 chipid)
  1765. {
  1766. return 0;
  1767. }
  1768. static int
  1769. w83781d_read_value(struct w83781d_data *data, u16 reg)
  1770. {
  1771. int res;
  1772. mutex_lock(&data->lock);
  1773. res = w83781d_read_value_i2c(data, reg);
  1774. mutex_unlock(&data->lock);
  1775. return res;
  1776. }
  1777. static int
  1778. w83781d_write_value(struct w83781d_data *data, u16 reg, u16 value)
  1779. {
  1780. mutex_lock(&data->lock);
  1781. w83781d_write_value_i2c(data, reg, value);
  1782. mutex_unlock(&data->lock);
  1783. return 0;
  1784. }
  1785. static int __init
  1786. w83781d_isa_register(void)
  1787. {
  1788. return 0;
  1789. }
  1790. static void
  1791. w83781d_isa_unregister(void)
  1792. {
  1793. }
  1794. #endif /* CONFIG_ISA */
  1795. static int __init
  1796. sensors_w83781d_init(void)
  1797. {
  1798. int res;
  1799. /*
  1800. * We register the ISA device first, so that we can skip the
  1801. * registration of an I2C interface to the same device.
  1802. */
  1803. res = w83781d_isa_register();
  1804. if (res)
  1805. goto exit;
  1806. res = i2c_add_driver(&w83781d_driver);
  1807. if (res)
  1808. goto exit_unreg_isa;
  1809. return 0;
  1810. exit_unreg_isa:
  1811. w83781d_isa_unregister();
  1812. exit:
  1813. return res;
  1814. }
  1815. static void __exit
  1816. sensors_w83781d_exit(void)
  1817. {
  1818. w83781d_isa_unregister();
  1819. i2c_del_driver(&w83781d_driver);
  1820. }
  1821. MODULE_AUTHOR("Frodo Looijaard <frodol@dds.nl>, "
  1822. "Philip Edelbrock <phil@netroedge.com>, "
  1823. "and Mark Studebaker <mdsxyz123@yahoo.com>");
  1824. MODULE_DESCRIPTION("W83781D driver");
  1825. MODULE_LICENSE("GPL");
  1826. module_init(sensors_w83781d_init);
  1827. module_exit(sensors_w83781d_exit);