dme1737.c 68 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412
  1. /*
  2. * dme1737.c - Driver for the SMSC DME1737, Asus A8000, and SMSC SCH311x
  3. * Super-I/O chips integrated hardware monitoring features.
  4. * Copyright (c) 2007 Juerg Haefliger <juergh@gmail.com>
  5. *
  6. * This driver is an I2C/ISA hybrid, meaning that it uses the I2C bus to access
  7. * the chip registers if a DME1737 (or A8000) is found and the ISA bus if a
  8. * SCH311x chip is found. Both types of chips have very similar hardware
  9. * monitoring capabilities but differ in the way they can be accessed.
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License as published by
  13. * the Free Software Foundation; either version 2 of the License, or
  14. * (at your option) any later version.
  15. *
  16. * This program is distributed in the hope that it will be useful,
  17. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  19. * GNU General Public License for more details.
  20. *
  21. * You should have received a copy of the GNU General Public License
  22. * along with this program; if not, write to the Free Software
  23. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  24. */
  25. #include <linux/module.h>
  26. #include <linux/init.h>
  27. #include <linux/slab.h>
  28. #include <linux/jiffies.h>
  29. #include <linux/i2c.h>
  30. #include <linux/platform_device.h>
  31. #include <linux/hwmon.h>
  32. #include <linux/hwmon-sysfs.h>
  33. #include <linux/hwmon-vid.h>
  34. #include <linux/err.h>
  35. #include <linux/mutex.h>
  36. #include <asm/io.h>
  37. /* ISA device, if found */
  38. static struct platform_device *pdev;
  39. /* Module load parameters */
  40. static int force_start;
  41. module_param(force_start, bool, 0);
  42. MODULE_PARM_DESC(force_start, "Force the chip to start monitoring inputs");
  43. static unsigned short force_id;
  44. module_param(force_id, ushort, 0);
  45. MODULE_PARM_DESC(force_id, "Override the detected device ID");
  46. /* Addresses to scan */
  47. static unsigned short normal_i2c[] = {0x2c, 0x2d, 0x2e, I2C_CLIENT_END};
  48. /* Insmod parameters */
  49. I2C_CLIENT_INSMOD_1(dme1737);
  50. /* ---------------------------------------------------------------------
  51. * Registers
  52. *
  53. * The sensors are defined as follows:
  54. *
  55. * Voltages Temperatures
  56. * -------- ------------
  57. * in0 +5VTR (+5V stdby) temp1 Remote diode 1
  58. * in1 Vccp (proc core) temp2 Internal temp
  59. * in2 VCC (internal +3.3V) temp3 Remote diode 2
  60. * in3 +5V
  61. * in4 +12V
  62. * in5 VTR (+3.3V stby)
  63. * in6 Vbat
  64. *
  65. * --------------------------------------------------------------------- */
  66. /* Voltages (in) numbered 0-6 (ix) */
  67. #define DME1737_REG_IN(ix) ((ix) < 5 ? 0x20 + (ix) \
  68. : 0x94 + (ix))
  69. #define DME1737_REG_IN_MIN(ix) ((ix) < 5 ? 0x44 + (ix) * 2 \
  70. : 0x91 + (ix) * 2)
  71. #define DME1737_REG_IN_MAX(ix) ((ix) < 5 ? 0x45 + (ix) * 2 \
  72. : 0x92 + (ix) * 2)
  73. /* Temperatures (temp) numbered 0-2 (ix) */
  74. #define DME1737_REG_TEMP(ix) (0x25 + (ix))
  75. #define DME1737_REG_TEMP_MIN(ix) (0x4e + (ix) * 2)
  76. #define DME1737_REG_TEMP_MAX(ix) (0x4f + (ix) * 2)
  77. #define DME1737_REG_TEMP_OFFSET(ix) ((ix) == 0 ? 0x1f \
  78. : 0x1c + (ix))
  79. /* Voltage and temperature LSBs
  80. * The LSBs (4 bits each) are stored in 5 registers with the following layouts:
  81. * IN_TEMP_LSB(0) = [in5, in6]
  82. * IN_TEMP_LSB(1) = [temp3, temp1]
  83. * IN_TEMP_LSB(2) = [in4, temp2]
  84. * IN_TEMP_LSB(3) = [in3, in0]
  85. * IN_TEMP_LSB(4) = [in2, in1] */
  86. #define DME1737_REG_IN_TEMP_LSB(ix) (0x84 + (ix))
  87. static const u8 DME1737_REG_IN_LSB[] = {3, 4, 4, 3, 2, 0, 0};
  88. static const u8 DME1737_REG_IN_LSB_SHL[] = {4, 4, 0, 0, 0, 0, 4};
  89. static const u8 DME1737_REG_TEMP_LSB[] = {1, 2, 1};
  90. static const u8 DME1737_REG_TEMP_LSB_SHL[] = {4, 4, 0};
  91. /* Fans numbered 0-5 (ix) */
  92. #define DME1737_REG_FAN(ix) ((ix) < 4 ? 0x28 + (ix) * 2 \
  93. : 0xa1 + (ix) * 2)
  94. #define DME1737_REG_FAN_MIN(ix) ((ix) < 4 ? 0x54 + (ix) * 2 \
  95. : 0xa5 + (ix) * 2)
  96. #define DME1737_REG_FAN_OPT(ix) ((ix) < 4 ? 0x90 + (ix) \
  97. : 0xb2 + (ix))
  98. #define DME1737_REG_FAN_MAX(ix) (0xb4 + (ix)) /* only for fan[4-5] */
  99. /* PWMs numbered 0-2, 4-5 (ix) */
  100. #define DME1737_REG_PWM(ix) ((ix) < 3 ? 0x30 + (ix) \
  101. : 0xa1 + (ix))
  102. #define DME1737_REG_PWM_CONFIG(ix) (0x5c + (ix)) /* only for pwm[0-2] */
  103. #define DME1737_REG_PWM_MIN(ix) (0x64 + (ix)) /* only for pwm[0-2] */
  104. #define DME1737_REG_PWM_FREQ(ix) ((ix) < 3 ? 0x5f + (ix) \
  105. : 0xa3 + (ix))
  106. /* The layout of the ramp rate registers is different from the other pwm
  107. * registers. The bits for the 3 PWMs are stored in 2 registers:
  108. * PWM_RR(0) = [OFF3, OFF2, OFF1, RES, RR1E, RR1-2, RR1-1, RR1-0]
  109. * PWM_RR(1) = [RR2E, RR2-2, RR2-1, RR2-0, RR3E, RR3-2, RR3-1, RR3-0] */
  110. #define DME1737_REG_PWM_RR(ix) (0x62 + (ix)) /* only for pwm[0-2] */
  111. /* Thermal zones 0-2 */
  112. #define DME1737_REG_ZONE_LOW(ix) (0x67 + (ix))
  113. #define DME1737_REG_ZONE_ABS(ix) (0x6a + (ix))
  114. /* The layout of the hysteresis registers is different from the other zone
  115. * registers. The bits for the 3 zones are stored in 2 registers:
  116. * ZONE_HYST(0) = [H1-3, H1-2, H1-1, H1-0, H2-3, H2-2, H2-1, H2-0]
  117. * ZONE_HYST(1) = [H3-3, H3-2, H3-1, H3-0, RES, RES, RES, RES] */
  118. #define DME1737_REG_ZONE_HYST(ix) (0x6d + (ix))
  119. /* Alarm registers and bit mapping
  120. * The 3 8-bit alarm registers will be concatenated to a single 32-bit
  121. * alarm value [0, ALARM3, ALARM2, ALARM1]. */
  122. #define DME1737_REG_ALARM1 0x41
  123. #define DME1737_REG_ALARM2 0x42
  124. #define DME1737_REG_ALARM3 0x83
  125. static const u8 DME1737_BIT_ALARM_IN[] = {0, 1, 2, 3, 8, 16, 17};
  126. static const u8 DME1737_BIT_ALARM_TEMP[] = {4, 5, 6};
  127. static const u8 DME1737_BIT_ALARM_FAN[] = {10, 11, 12, 13, 22, 23};
  128. /* Miscellaneous registers */
  129. #define DME1737_REG_DEVICE 0x3d
  130. #define DME1737_REG_COMPANY 0x3e
  131. #define DME1737_REG_VERSTEP 0x3f
  132. #define DME1737_REG_CONFIG 0x40
  133. #define DME1737_REG_CONFIG2 0x7f
  134. #define DME1737_REG_VID 0x43
  135. #define DME1737_REG_TACH_PWM 0x81
  136. /* ---------------------------------------------------------------------
  137. * Misc defines
  138. * --------------------------------------------------------------------- */
  139. /* Chip identification */
  140. #define DME1737_COMPANY_SMSC 0x5c
  141. #define DME1737_VERSTEP 0x88
  142. #define DME1737_VERSTEP_MASK 0xf8
  143. #define SCH311X_DEVICE 0x8c
  144. /* Length of ISA address segment */
  145. #define DME1737_EXTENT 2
  146. /* ---------------------------------------------------------------------
  147. * Data structures and manipulation thereof
  148. * --------------------------------------------------------------------- */
  149. /* For ISA chips, we abuse the i2c_client addr and name fields. We also use
  150. the driver field to differentiate between I2C and ISA chips. */
  151. struct dme1737_data {
  152. struct i2c_client client;
  153. struct device *hwmon_dev;
  154. struct mutex update_lock;
  155. int valid; /* !=0 if following fields are valid */
  156. unsigned long last_update; /* in jiffies */
  157. unsigned long last_vbat; /* in jiffies */
  158. u8 vid;
  159. u8 pwm_rr_en;
  160. u8 has_pwm;
  161. u8 has_fan;
  162. /* Register values */
  163. u16 in[7];
  164. u8 in_min[7];
  165. u8 in_max[7];
  166. s16 temp[3];
  167. s8 temp_min[3];
  168. s8 temp_max[3];
  169. s8 temp_offset[3];
  170. u8 config;
  171. u8 config2;
  172. u8 vrm;
  173. u16 fan[6];
  174. u16 fan_min[6];
  175. u8 fan_max[2];
  176. u8 fan_opt[6];
  177. u8 pwm[6];
  178. u8 pwm_min[3];
  179. u8 pwm_config[3];
  180. u8 pwm_acz[3];
  181. u8 pwm_freq[6];
  182. u8 pwm_rr[2];
  183. u8 zone_low[3];
  184. u8 zone_abs[3];
  185. u8 zone_hyst[2];
  186. u32 alarms;
  187. };
  188. /* Nominal voltage values */
  189. static const int IN_NOMINAL[] = {5000, 2250, 3300, 5000, 12000, 3300, 3300};
  190. /* Voltage input
  191. * Voltage inputs have 16 bits resolution, limit values have 8 bits
  192. * resolution. */
  193. static inline int IN_FROM_REG(int reg, int ix, int res)
  194. {
  195. return (reg * IN_NOMINAL[ix] + (3 << (res - 3))) / (3 << (res - 2));
  196. }
  197. static inline int IN_TO_REG(int val, int ix)
  198. {
  199. return SENSORS_LIMIT((val * 192 + IN_NOMINAL[ix] / 2) /
  200. IN_NOMINAL[ix], 0, 255);
  201. }
  202. /* Temperature input
  203. * The register values represent temperatures in 2's complement notation from
  204. * -127 degrees C to +127 degrees C. Temp inputs have 16 bits resolution, limit
  205. * values have 8 bits resolution. */
  206. static inline int TEMP_FROM_REG(int reg, int res)
  207. {
  208. return (reg * 1000) >> (res - 8);
  209. }
  210. static inline int TEMP_TO_REG(int val)
  211. {
  212. return SENSORS_LIMIT((val < 0 ? val - 500 : val + 500) / 1000,
  213. -128, 127);
  214. }
  215. /* Temperature range */
  216. static const int TEMP_RANGE[] = {2000, 2500, 3333, 4000, 5000, 6666, 8000,
  217. 10000, 13333, 16000, 20000, 26666, 32000,
  218. 40000, 53333, 80000};
  219. static inline int TEMP_RANGE_FROM_REG(int reg)
  220. {
  221. return TEMP_RANGE[(reg >> 4) & 0x0f];
  222. }
  223. static int TEMP_RANGE_TO_REG(int val, int reg)
  224. {
  225. int i;
  226. for (i = 15; i > 0; i--) {
  227. if (val > (TEMP_RANGE[i] + TEMP_RANGE[i - 1] + 1) / 2) {
  228. break;
  229. }
  230. }
  231. return (reg & 0x0f) | (i << 4);
  232. }
  233. /* Temperature hysteresis
  234. * Register layout:
  235. * reg[0] = [H1-3, H1-2, H1-1, H1-0, H2-3, H2-2, H2-1, H2-0]
  236. * reg[1] = [H3-3, H3-2, H3-1, H3-0, xxxx, xxxx, xxxx, xxxx] */
  237. static inline int TEMP_HYST_FROM_REG(int reg, int ix)
  238. {
  239. return (((ix == 1) ? reg : reg >> 4) & 0x0f) * 1000;
  240. }
  241. static inline int TEMP_HYST_TO_REG(int val, int ix, int reg)
  242. {
  243. int hyst = SENSORS_LIMIT((val + 500) / 1000, 0, 15);
  244. return (ix == 1) ? (reg & 0xf0) | hyst : (reg & 0x0f) | (hyst << 4);
  245. }
  246. /* Fan input RPM */
  247. static inline int FAN_FROM_REG(int reg, int tpc)
  248. {
  249. return (reg == 0 || reg == 0xffff) ? 0 :
  250. (tpc == 0) ? 90000 * 60 / reg : tpc * reg;
  251. }
  252. static inline int FAN_TO_REG(int val, int tpc)
  253. {
  254. return SENSORS_LIMIT((tpc == 0) ? 90000 * 60 / val : val / tpc,
  255. 0, 0xffff);
  256. }
  257. /* Fan TPC (tach pulse count)
  258. * Converts a register value to a TPC multiplier or returns 0 if the tachometer
  259. * is configured in legacy (non-tpc) mode */
  260. static inline int FAN_TPC_FROM_REG(int reg)
  261. {
  262. return (reg & 0x20) ? 0 : 60 >> (reg & 0x03);
  263. }
  264. /* Fan type
  265. * The type of a fan is expressed in number of pulses-per-revolution that it
  266. * emits */
  267. static inline int FAN_TYPE_FROM_REG(int reg)
  268. {
  269. int edge = (reg >> 1) & 0x03;
  270. return (edge > 0) ? 1 << (edge - 1) : 0;
  271. }
  272. static inline int FAN_TYPE_TO_REG(int val, int reg)
  273. {
  274. int edge = (val == 4) ? 3 : val;
  275. return (reg & 0xf9) | (edge << 1);
  276. }
  277. /* Fan max RPM */
  278. static const int FAN_MAX[] = {0x54, 0x38, 0x2a, 0x21, 0x1c, 0x18, 0x15, 0x12,
  279. 0x11, 0x0f, 0x0e};
  280. static int FAN_MAX_FROM_REG(int reg)
  281. {
  282. int i;
  283. for (i = 10; i > 0; i--) {
  284. if (reg == FAN_MAX[i]) {
  285. break;
  286. }
  287. }
  288. return 1000 + i * 500;
  289. }
  290. static int FAN_MAX_TO_REG(int val)
  291. {
  292. int i;
  293. for (i = 10; i > 0; i--) {
  294. if (val > (1000 + (i - 1) * 500)) {
  295. break;
  296. }
  297. }
  298. return FAN_MAX[i];
  299. }
  300. /* PWM enable
  301. * Register to enable mapping:
  302. * 000: 2 fan on zone 1 auto
  303. * 001: 2 fan on zone 2 auto
  304. * 010: 2 fan on zone 3 auto
  305. * 011: 0 fan full on
  306. * 100: -1 fan disabled
  307. * 101: 2 fan on hottest of zones 2,3 auto
  308. * 110: 2 fan on hottest of zones 1,2,3 auto
  309. * 111: 1 fan in manual mode */
  310. static inline int PWM_EN_FROM_REG(int reg)
  311. {
  312. static const int en[] = {2, 2, 2, 0, -1, 2, 2, 1};
  313. return en[(reg >> 5) & 0x07];
  314. }
  315. static inline int PWM_EN_TO_REG(int val, int reg)
  316. {
  317. int en = (val == 1) ? 7 : 3;
  318. return (reg & 0x1f) | ((en & 0x07) << 5);
  319. }
  320. /* PWM auto channels zone
  321. * Register to auto channels zone mapping (ACZ is a bitfield with bit x
  322. * corresponding to zone x+1):
  323. * 000: 001 fan on zone 1 auto
  324. * 001: 010 fan on zone 2 auto
  325. * 010: 100 fan on zone 3 auto
  326. * 011: 000 fan full on
  327. * 100: 000 fan disabled
  328. * 101: 110 fan on hottest of zones 2,3 auto
  329. * 110: 111 fan on hottest of zones 1,2,3 auto
  330. * 111: 000 fan in manual mode */
  331. static inline int PWM_ACZ_FROM_REG(int reg)
  332. {
  333. static const int acz[] = {1, 2, 4, 0, 0, 6, 7, 0};
  334. return acz[(reg >> 5) & 0x07];
  335. }
  336. static inline int PWM_ACZ_TO_REG(int val, int reg)
  337. {
  338. int acz = (val == 4) ? 2 : val - 1;
  339. return (reg & 0x1f) | ((acz & 0x07) << 5);
  340. }
  341. /* PWM frequency */
  342. static const int PWM_FREQ[] = {11, 15, 22, 29, 35, 44, 59, 88,
  343. 15000, 20000, 30000, 25000, 0, 0, 0, 0};
  344. static inline int PWM_FREQ_FROM_REG(int reg)
  345. {
  346. return PWM_FREQ[reg & 0x0f];
  347. }
  348. static int PWM_FREQ_TO_REG(int val, int reg)
  349. {
  350. int i;
  351. /* the first two cases are special - stupid chip design! */
  352. if (val > 27500) {
  353. i = 10;
  354. } else if (val > 22500) {
  355. i = 11;
  356. } else {
  357. for (i = 9; i > 0; i--) {
  358. if (val > (PWM_FREQ[i] + PWM_FREQ[i - 1] + 1) / 2) {
  359. break;
  360. }
  361. }
  362. }
  363. return (reg & 0xf0) | i;
  364. }
  365. /* PWM ramp rate
  366. * Register layout:
  367. * reg[0] = [OFF3, OFF2, OFF1, RES, RR1-E, RR1-2, RR1-1, RR1-0]
  368. * reg[1] = [RR2-E, RR2-2, RR2-1, RR2-0, RR3-E, RR3-2, RR3-1, RR3-0] */
  369. static const u8 PWM_RR[] = {206, 104, 69, 41, 26, 18, 10, 5};
  370. static inline int PWM_RR_FROM_REG(int reg, int ix)
  371. {
  372. int rr = (ix == 1) ? reg >> 4 : reg;
  373. return (rr & 0x08) ? PWM_RR[rr & 0x07] : 0;
  374. }
  375. static int PWM_RR_TO_REG(int val, int ix, int reg)
  376. {
  377. int i;
  378. for (i = 0; i < 7; i++) {
  379. if (val > (PWM_RR[i] + PWM_RR[i + 1] + 1) / 2) {
  380. break;
  381. }
  382. }
  383. return (ix == 1) ? (reg & 0x8f) | (i << 4) : (reg & 0xf8) | i;
  384. }
  385. /* PWM ramp rate enable */
  386. static inline int PWM_RR_EN_FROM_REG(int reg, int ix)
  387. {
  388. return PWM_RR_FROM_REG(reg, ix) ? 1 : 0;
  389. }
  390. static inline int PWM_RR_EN_TO_REG(int val, int ix, int reg)
  391. {
  392. int en = (ix == 1) ? 0x80 : 0x08;
  393. return val ? reg | en : reg & ~en;
  394. }
  395. /* PWM min/off
  396. * The PWM min/off bits are part of the PMW ramp rate register 0 (see above for
  397. * the register layout). */
  398. static inline int PWM_OFF_FROM_REG(int reg, int ix)
  399. {
  400. return (reg >> (ix + 5)) & 0x01;
  401. }
  402. static inline int PWM_OFF_TO_REG(int val, int ix, int reg)
  403. {
  404. return (reg & ~(1 << (ix + 5))) | ((val & 0x01) << (ix + 5));
  405. }
  406. /* ---------------------------------------------------------------------
  407. * Device I/O access
  408. *
  409. * ISA access is performed through an index/data register pair and needs to
  410. * be protected by a mutex during runtime (not required for initialization).
  411. * We use data->update_lock for this and need to ensure that we acquire it
  412. * before calling dme1737_read or dme1737_write.
  413. * --------------------------------------------------------------------- */
  414. static u8 dme1737_read(struct i2c_client *client, u8 reg)
  415. {
  416. s32 val;
  417. if (client->driver) { /* I2C device */
  418. val = i2c_smbus_read_byte_data(client, reg);
  419. if (val < 0) {
  420. dev_warn(&client->dev, "Read from register "
  421. "0x%02x failed! Please report to the driver "
  422. "maintainer.\n", reg);
  423. }
  424. } else { /* ISA device */
  425. outb(reg, client->addr);
  426. val = inb(client->addr + 1);
  427. }
  428. return val;
  429. }
  430. static s32 dme1737_write(struct i2c_client *client, u8 reg, u8 val)
  431. {
  432. s32 res = 0;
  433. if (client->driver) { /* I2C device */
  434. res = i2c_smbus_write_byte_data(client, reg, val);
  435. if (res < 0) {
  436. dev_warn(&client->dev, "Write to register "
  437. "0x%02x failed! Please report to the driver "
  438. "maintainer.\n", reg);
  439. }
  440. } else { /* ISA device */
  441. outb(reg, client->addr);
  442. outb(val, client->addr + 1);
  443. }
  444. return res;
  445. }
  446. static struct dme1737_data *dme1737_update_device(struct device *dev)
  447. {
  448. struct dme1737_data *data = dev_get_drvdata(dev);
  449. struct i2c_client *client = &data->client;
  450. int ix;
  451. u8 lsb[5];
  452. mutex_lock(&data->update_lock);
  453. /* Enable a Vbat monitoring cycle every 10 mins */
  454. if (time_after(jiffies, data->last_vbat + 600 * HZ) || !data->valid) {
  455. dme1737_write(client, DME1737_REG_CONFIG, dme1737_read(client,
  456. DME1737_REG_CONFIG) | 0x10);
  457. data->last_vbat = jiffies;
  458. }
  459. /* Sample register contents every 1 sec */
  460. if (time_after(jiffies, data->last_update + HZ) || !data->valid) {
  461. data->vid = dme1737_read(client, DME1737_REG_VID) & 0x3f;
  462. /* In (voltage) registers */
  463. for (ix = 0; ix < ARRAY_SIZE(data->in); ix++) {
  464. /* Voltage inputs are stored as 16 bit values even
  465. * though they have only 12 bits resolution. This is
  466. * to make it consistent with the temp inputs. */
  467. data->in[ix] = dme1737_read(client,
  468. DME1737_REG_IN(ix)) << 8;
  469. data->in_min[ix] = dme1737_read(client,
  470. DME1737_REG_IN_MIN(ix));
  471. data->in_max[ix] = dme1737_read(client,
  472. DME1737_REG_IN_MAX(ix));
  473. }
  474. /* Temp registers */
  475. for (ix = 0; ix < ARRAY_SIZE(data->temp); ix++) {
  476. /* Temp inputs are stored as 16 bit values even
  477. * though they have only 12 bits resolution. This is
  478. * to take advantage of implicit conversions between
  479. * register values (2's complement) and temp values
  480. * (signed decimal). */
  481. data->temp[ix] = dme1737_read(client,
  482. DME1737_REG_TEMP(ix)) << 8;
  483. data->temp_min[ix] = dme1737_read(client,
  484. DME1737_REG_TEMP_MIN(ix));
  485. data->temp_max[ix] = dme1737_read(client,
  486. DME1737_REG_TEMP_MAX(ix));
  487. data->temp_offset[ix] = dme1737_read(client,
  488. DME1737_REG_TEMP_OFFSET(ix));
  489. }
  490. /* In and temp LSB registers
  491. * The LSBs are latched when the MSBs are read, so the order in
  492. * which the registers are read (MSB first, then LSB) is
  493. * important! */
  494. for (ix = 0; ix < ARRAY_SIZE(lsb); ix++) {
  495. lsb[ix] = dme1737_read(client,
  496. DME1737_REG_IN_TEMP_LSB(ix));
  497. }
  498. for (ix = 0; ix < ARRAY_SIZE(data->in); ix++) {
  499. data->in[ix] |= (lsb[DME1737_REG_IN_LSB[ix]] <<
  500. DME1737_REG_IN_LSB_SHL[ix]) & 0xf0;
  501. }
  502. for (ix = 0; ix < ARRAY_SIZE(data->temp); ix++) {
  503. data->temp[ix] |= (lsb[DME1737_REG_TEMP_LSB[ix]] <<
  504. DME1737_REG_TEMP_LSB_SHL[ix]) & 0xf0;
  505. }
  506. /* Fan registers */
  507. for (ix = 0; ix < ARRAY_SIZE(data->fan); ix++) {
  508. /* Skip reading registers if optional fans are not
  509. * present */
  510. if (!(data->has_fan & (1 << ix))) {
  511. continue;
  512. }
  513. data->fan[ix] = dme1737_read(client,
  514. DME1737_REG_FAN(ix));
  515. data->fan[ix] |= dme1737_read(client,
  516. DME1737_REG_FAN(ix) + 1) << 8;
  517. data->fan_min[ix] = dme1737_read(client,
  518. DME1737_REG_FAN_MIN(ix));
  519. data->fan_min[ix] |= dme1737_read(client,
  520. DME1737_REG_FAN_MIN(ix) + 1) << 8;
  521. data->fan_opt[ix] = dme1737_read(client,
  522. DME1737_REG_FAN_OPT(ix));
  523. /* fan_max exists only for fan[5-6] */
  524. if (ix > 3) {
  525. data->fan_max[ix - 4] = dme1737_read(client,
  526. DME1737_REG_FAN_MAX(ix));
  527. }
  528. }
  529. /* PWM registers */
  530. for (ix = 0; ix < ARRAY_SIZE(data->pwm); ix++) {
  531. /* Skip reading registers if optional PWMs are not
  532. * present */
  533. if (!(data->has_pwm & (1 << ix))) {
  534. continue;
  535. }
  536. data->pwm[ix] = dme1737_read(client,
  537. DME1737_REG_PWM(ix));
  538. data->pwm_freq[ix] = dme1737_read(client,
  539. DME1737_REG_PWM_FREQ(ix));
  540. /* pwm_config and pwm_min exist only for pwm[1-3] */
  541. if (ix < 3) {
  542. data->pwm_config[ix] = dme1737_read(client,
  543. DME1737_REG_PWM_CONFIG(ix));
  544. data->pwm_min[ix] = dme1737_read(client,
  545. DME1737_REG_PWM_MIN(ix));
  546. }
  547. }
  548. for (ix = 0; ix < ARRAY_SIZE(data->pwm_rr); ix++) {
  549. data->pwm_rr[ix] = dme1737_read(client,
  550. DME1737_REG_PWM_RR(ix));
  551. }
  552. /* Thermal zone registers */
  553. for (ix = 0; ix < ARRAY_SIZE(data->zone_low); ix++) {
  554. data->zone_low[ix] = dme1737_read(client,
  555. DME1737_REG_ZONE_LOW(ix));
  556. data->zone_abs[ix] = dme1737_read(client,
  557. DME1737_REG_ZONE_ABS(ix));
  558. }
  559. for (ix = 0; ix < ARRAY_SIZE(data->zone_hyst); ix++) {
  560. data->zone_hyst[ix] = dme1737_read(client,
  561. DME1737_REG_ZONE_HYST(ix));
  562. }
  563. /* Alarm registers */
  564. data->alarms = dme1737_read(client,
  565. DME1737_REG_ALARM1);
  566. /* Bit 7 tells us if the other alarm registers are non-zero and
  567. * therefore also need to be read */
  568. if (data->alarms & 0x80) {
  569. data->alarms |= dme1737_read(client,
  570. DME1737_REG_ALARM2) << 8;
  571. data->alarms |= dme1737_read(client,
  572. DME1737_REG_ALARM3) << 16;
  573. }
  574. /* The ISA chips require explicit clearing of alarm bits.
  575. * Don't worry, an alarm will come back if the condition
  576. * that causes it still exists */
  577. if (!client->driver) {
  578. if (data->alarms & 0xff0000) {
  579. dme1737_write(client, DME1737_REG_ALARM3,
  580. 0xff);
  581. }
  582. if (data->alarms & 0xff00) {
  583. dme1737_write(client, DME1737_REG_ALARM2,
  584. 0xff);
  585. }
  586. if (data->alarms & 0xff) {
  587. dme1737_write(client, DME1737_REG_ALARM1,
  588. 0xff);
  589. }
  590. }
  591. data->last_update = jiffies;
  592. data->valid = 1;
  593. }
  594. mutex_unlock(&data->update_lock);
  595. return data;
  596. }
  597. /* ---------------------------------------------------------------------
  598. * Voltage sysfs attributes
  599. * ix = [0-5]
  600. * --------------------------------------------------------------------- */
  601. #define SYS_IN_INPUT 0
  602. #define SYS_IN_MIN 1
  603. #define SYS_IN_MAX 2
  604. #define SYS_IN_ALARM 3
  605. static ssize_t show_in(struct device *dev, struct device_attribute *attr,
  606. char *buf)
  607. {
  608. struct dme1737_data *data = dme1737_update_device(dev);
  609. struct sensor_device_attribute_2
  610. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  611. int ix = sensor_attr_2->index;
  612. int fn = sensor_attr_2->nr;
  613. int res;
  614. switch (fn) {
  615. case SYS_IN_INPUT:
  616. res = IN_FROM_REG(data->in[ix], ix, 16);
  617. break;
  618. case SYS_IN_MIN:
  619. res = IN_FROM_REG(data->in_min[ix], ix, 8);
  620. break;
  621. case SYS_IN_MAX:
  622. res = IN_FROM_REG(data->in_max[ix], ix, 8);
  623. break;
  624. case SYS_IN_ALARM:
  625. res = (data->alarms >> DME1737_BIT_ALARM_IN[ix]) & 0x01;
  626. break;
  627. default:
  628. res = 0;
  629. dev_dbg(dev, "Unknown function %d.\n", fn);
  630. }
  631. return sprintf(buf, "%d\n", res);
  632. }
  633. static ssize_t set_in(struct device *dev, struct device_attribute *attr,
  634. const char *buf, size_t count)
  635. {
  636. struct dme1737_data *data = dev_get_drvdata(dev);
  637. struct i2c_client *client = &data->client;
  638. struct sensor_device_attribute_2
  639. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  640. int ix = sensor_attr_2->index;
  641. int fn = sensor_attr_2->nr;
  642. long val = simple_strtol(buf, NULL, 10);
  643. mutex_lock(&data->update_lock);
  644. switch (fn) {
  645. case SYS_IN_MIN:
  646. data->in_min[ix] = IN_TO_REG(val, ix);
  647. dme1737_write(client, DME1737_REG_IN_MIN(ix),
  648. data->in_min[ix]);
  649. break;
  650. case SYS_IN_MAX:
  651. data->in_max[ix] = IN_TO_REG(val, ix);
  652. dme1737_write(client, DME1737_REG_IN_MAX(ix),
  653. data->in_max[ix]);
  654. break;
  655. default:
  656. dev_dbg(dev, "Unknown function %d.\n", fn);
  657. }
  658. mutex_unlock(&data->update_lock);
  659. return count;
  660. }
  661. /* ---------------------------------------------------------------------
  662. * Temperature sysfs attributes
  663. * ix = [0-2]
  664. * --------------------------------------------------------------------- */
  665. #define SYS_TEMP_INPUT 0
  666. #define SYS_TEMP_MIN 1
  667. #define SYS_TEMP_MAX 2
  668. #define SYS_TEMP_OFFSET 3
  669. #define SYS_TEMP_ALARM 4
  670. #define SYS_TEMP_FAULT 5
  671. static ssize_t show_temp(struct device *dev, struct device_attribute *attr,
  672. char *buf)
  673. {
  674. struct dme1737_data *data = dme1737_update_device(dev);
  675. struct sensor_device_attribute_2
  676. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  677. int ix = sensor_attr_2->index;
  678. int fn = sensor_attr_2->nr;
  679. int res;
  680. switch (fn) {
  681. case SYS_TEMP_INPUT:
  682. res = TEMP_FROM_REG(data->temp[ix], 16);
  683. break;
  684. case SYS_TEMP_MIN:
  685. res = TEMP_FROM_REG(data->temp_min[ix], 8);
  686. break;
  687. case SYS_TEMP_MAX:
  688. res = TEMP_FROM_REG(data->temp_max[ix], 8);
  689. break;
  690. case SYS_TEMP_OFFSET:
  691. res = TEMP_FROM_REG(data->temp_offset[ix], 8);
  692. break;
  693. case SYS_TEMP_ALARM:
  694. res = (data->alarms >> DME1737_BIT_ALARM_TEMP[ix]) & 0x01;
  695. break;
  696. case SYS_TEMP_FAULT:
  697. res = (((u16)data->temp[ix] & 0xff00) == 0x8000);
  698. break;
  699. default:
  700. res = 0;
  701. dev_dbg(dev, "Unknown function %d.\n", fn);
  702. }
  703. return sprintf(buf, "%d\n", res);
  704. }
  705. static ssize_t set_temp(struct device *dev, struct device_attribute *attr,
  706. const char *buf, size_t count)
  707. {
  708. struct dme1737_data *data = dev_get_drvdata(dev);
  709. struct i2c_client *client = &data->client;
  710. struct sensor_device_attribute_2
  711. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  712. int ix = sensor_attr_2->index;
  713. int fn = sensor_attr_2->nr;
  714. long val = simple_strtol(buf, NULL, 10);
  715. mutex_lock(&data->update_lock);
  716. switch (fn) {
  717. case SYS_TEMP_MIN:
  718. data->temp_min[ix] = TEMP_TO_REG(val);
  719. dme1737_write(client, DME1737_REG_TEMP_MIN(ix),
  720. data->temp_min[ix]);
  721. break;
  722. case SYS_TEMP_MAX:
  723. data->temp_max[ix] = TEMP_TO_REG(val);
  724. dme1737_write(client, DME1737_REG_TEMP_MAX(ix),
  725. data->temp_max[ix]);
  726. break;
  727. case SYS_TEMP_OFFSET:
  728. data->temp_offset[ix] = TEMP_TO_REG(val);
  729. dme1737_write(client, DME1737_REG_TEMP_OFFSET(ix),
  730. data->temp_offset[ix]);
  731. break;
  732. default:
  733. dev_dbg(dev, "Unknown function %d.\n", fn);
  734. }
  735. mutex_unlock(&data->update_lock);
  736. return count;
  737. }
  738. /* ---------------------------------------------------------------------
  739. * Zone sysfs attributes
  740. * ix = [0-2]
  741. * --------------------------------------------------------------------- */
  742. #define SYS_ZONE_AUTO_CHANNELS_TEMP 0
  743. #define SYS_ZONE_AUTO_POINT1_TEMP_HYST 1
  744. #define SYS_ZONE_AUTO_POINT1_TEMP 2
  745. #define SYS_ZONE_AUTO_POINT2_TEMP 3
  746. #define SYS_ZONE_AUTO_POINT3_TEMP 4
  747. static ssize_t show_zone(struct device *dev, struct device_attribute *attr,
  748. char *buf)
  749. {
  750. struct dme1737_data *data = dme1737_update_device(dev);
  751. struct sensor_device_attribute_2
  752. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  753. int ix = sensor_attr_2->index;
  754. int fn = sensor_attr_2->nr;
  755. int res;
  756. switch (fn) {
  757. case SYS_ZONE_AUTO_CHANNELS_TEMP:
  758. /* check config2 for non-standard temp-to-zone mapping */
  759. if ((ix == 1) && (data->config2 & 0x02)) {
  760. res = 4;
  761. } else {
  762. res = 1 << ix;
  763. }
  764. break;
  765. case SYS_ZONE_AUTO_POINT1_TEMP_HYST:
  766. res = TEMP_FROM_REG(data->zone_low[ix], 8) -
  767. TEMP_HYST_FROM_REG(data->zone_hyst[ix == 2], ix);
  768. break;
  769. case SYS_ZONE_AUTO_POINT1_TEMP:
  770. res = TEMP_FROM_REG(data->zone_low[ix], 8);
  771. break;
  772. case SYS_ZONE_AUTO_POINT2_TEMP:
  773. /* pwm_freq holds the temp range bits in the upper nibble */
  774. res = TEMP_FROM_REG(data->zone_low[ix], 8) +
  775. TEMP_RANGE_FROM_REG(data->pwm_freq[ix]);
  776. break;
  777. case SYS_ZONE_AUTO_POINT3_TEMP:
  778. res = TEMP_FROM_REG(data->zone_abs[ix], 8);
  779. break;
  780. default:
  781. res = 0;
  782. dev_dbg(dev, "Unknown function %d.\n", fn);
  783. }
  784. return sprintf(buf, "%d\n", res);
  785. }
  786. static ssize_t set_zone(struct device *dev, struct device_attribute *attr,
  787. const char *buf, size_t count)
  788. {
  789. struct dme1737_data *data = dev_get_drvdata(dev);
  790. struct i2c_client *client = &data->client;
  791. struct sensor_device_attribute_2
  792. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  793. int ix = sensor_attr_2->index;
  794. int fn = sensor_attr_2->nr;
  795. long val = simple_strtol(buf, NULL, 10);
  796. mutex_lock(&data->update_lock);
  797. switch (fn) {
  798. case SYS_ZONE_AUTO_POINT1_TEMP_HYST:
  799. /* Refresh the cache */
  800. data->zone_low[ix] = dme1737_read(client,
  801. DME1737_REG_ZONE_LOW(ix));
  802. /* Modify the temp hyst value */
  803. data->zone_hyst[ix == 2] = TEMP_HYST_TO_REG(
  804. TEMP_FROM_REG(data->zone_low[ix], 8) -
  805. val, ix, dme1737_read(client,
  806. DME1737_REG_ZONE_HYST(ix == 2)));
  807. dme1737_write(client, DME1737_REG_ZONE_HYST(ix == 2),
  808. data->zone_hyst[ix == 2]);
  809. break;
  810. case SYS_ZONE_AUTO_POINT1_TEMP:
  811. data->zone_low[ix] = TEMP_TO_REG(val);
  812. dme1737_write(client, DME1737_REG_ZONE_LOW(ix),
  813. data->zone_low[ix]);
  814. break;
  815. case SYS_ZONE_AUTO_POINT2_TEMP:
  816. /* Refresh the cache */
  817. data->zone_low[ix] = dme1737_read(client,
  818. DME1737_REG_ZONE_LOW(ix));
  819. /* Modify the temp range value (which is stored in the upper
  820. * nibble of the pwm_freq register) */
  821. data->pwm_freq[ix] = TEMP_RANGE_TO_REG(val -
  822. TEMP_FROM_REG(data->zone_low[ix], 8),
  823. dme1737_read(client,
  824. DME1737_REG_PWM_FREQ(ix)));
  825. dme1737_write(client, DME1737_REG_PWM_FREQ(ix),
  826. data->pwm_freq[ix]);
  827. break;
  828. case SYS_ZONE_AUTO_POINT3_TEMP:
  829. data->zone_abs[ix] = TEMP_TO_REG(val);
  830. dme1737_write(client, DME1737_REG_ZONE_ABS(ix),
  831. data->zone_abs[ix]);
  832. break;
  833. default:
  834. dev_dbg(dev, "Unknown function %d.\n", fn);
  835. }
  836. mutex_unlock(&data->update_lock);
  837. return count;
  838. }
  839. /* ---------------------------------------------------------------------
  840. * Fan sysfs attributes
  841. * ix = [0-5]
  842. * --------------------------------------------------------------------- */
  843. #define SYS_FAN_INPUT 0
  844. #define SYS_FAN_MIN 1
  845. #define SYS_FAN_MAX 2
  846. #define SYS_FAN_ALARM 3
  847. #define SYS_FAN_TYPE 4
  848. static ssize_t show_fan(struct device *dev, struct device_attribute *attr,
  849. char *buf)
  850. {
  851. struct dme1737_data *data = dme1737_update_device(dev);
  852. struct sensor_device_attribute_2
  853. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  854. int ix = sensor_attr_2->index;
  855. int fn = sensor_attr_2->nr;
  856. int res;
  857. switch (fn) {
  858. case SYS_FAN_INPUT:
  859. res = FAN_FROM_REG(data->fan[ix],
  860. ix < 4 ? 0 :
  861. FAN_TPC_FROM_REG(data->fan_opt[ix]));
  862. break;
  863. case SYS_FAN_MIN:
  864. res = FAN_FROM_REG(data->fan_min[ix],
  865. ix < 4 ? 0 :
  866. FAN_TPC_FROM_REG(data->fan_opt[ix]));
  867. break;
  868. case SYS_FAN_MAX:
  869. /* only valid for fan[5-6] */
  870. res = FAN_MAX_FROM_REG(data->fan_max[ix - 4]);
  871. break;
  872. case SYS_FAN_ALARM:
  873. res = (data->alarms >> DME1737_BIT_ALARM_FAN[ix]) & 0x01;
  874. break;
  875. case SYS_FAN_TYPE:
  876. /* only valid for fan[1-4] */
  877. res = FAN_TYPE_FROM_REG(data->fan_opt[ix]);
  878. break;
  879. default:
  880. res = 0;
  881. dev_dbg(dev, "Unknown function %d.\n", fn);
  882. }
  883. return sprintf(buf, "%d\n", res);
  884. }
  885. static ssize_t set_fan(struct device *dev, struct device_attribute *attr,
  886. const char *buf, size_t count)
  887. {
  888. struct dme1737_data *data = dev_get_drvdata(dev);
  889. struct i2c_client *client = &data->client;
  890. struct sensor_device_attribute_2
  891. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  892. int ix = sensor_attr_2->index;
  893. int fn = sensor_attr_2->nr;
  894. long val = simple_strtol(buf, NULL, 10);
  895. mutex_lock(&data->update_lock);
  896. switch (fn) {
  897. case SYS_FAN_MIN:
  898. if (ix < 4) {
  899. data->fan_min[ix] = FAN_TO_REG(val, 0);
  900. } else {
  901. /* Refresh the cache */
  902. data->fan_opt[ix] = dme1737_read(client,
  903. DME1737_REG_FAN_OPT(ix));
  904. /* Modify the fan min value */
  905. data->fan_min[ix] = FAN_TO_REG(val,
  906. FAN_TPC_FROM_REG(data->fan_opt[ix]));
  907. }
  908. dme1737_write(client, DME1737_REG_FAN_MIN(ix),
  909. data->fan_min[ix] & 0xff);
  910. dme1737_write(client, DME1737_REG_FAN_MIN(ix) + 1,
  911. data->fan_min[ix] >> 8);
  912. break;
  913. case SYS_FAN_MAX:
  914. /* Only valid for fan[5-6] */
  915. data->fan_max[ix - 4] = FAN_MAX_TO_REG(val);
  916. dme1737_write(client, DME1737_REG_FAN_MAX(ix),
  917. data->fan_max[ix - 4]);
  918. break;
  919. case SYS_FAN_TYPE:
  920. /* Only valid for fan[1-4] */
  921. if (!(val == 1 || val == 2 || val == 4)) {
  922. count = -EINVAL;
  923. dev_warn(dev, "Fan type value %ld not "
  924. "supported. Choose one of 1, 2, or 4.\n",
  925. val);
  926. goto exit;
  927. }
  928. data->fan_opt[ix] = FAN_TYPE_TO_REG(val, dme1737_read(client,
  929. DME1737_REG_FAN_OPT(ix)));
  930. dme1737_write(client, DME1737_REG_FAN_OPT(ix),
  931. data->fan_opt[ix]);
  932. break;
  933. default:
  934. dev_dbg(dev, "Unknown function %d.\n", fn);
  935. }
  936. exit:
  937. mutex_unlock(&data->update_lock);
  938. return count;
  939. }
  940. /* ---------------------------------------------------------------------
  941. * PWM sysfs attributes
  942. * ix = [0-4]
  943. * --------------------------------------------------------------------- */
  944. #define SYS_PWM 0
  945. #define SYS_PWM_FREQ 1
  946. #define SYS_PWM_ENABLE 2
  947. #define SYS_PWM_RAMP_RATE 3
  948. #define SYS_PWM_AUTO_CHANNELS_ZONE 4
  949. #define SYS_PWM_AUTO_PWM_MIN 5
  950. #define SYS_PWM_AUTO_POINT1_PWM 6
  951. #define SYS_PWM_AUTO_POINT2_PWM 7
  952. static ssize_t show_pwm(struct device *dev, struct device_attribute *attr,
  953. char *buf)
  954. {
  955. struct dme1737_data *data = dme1737_update_device(dev);
  956. struct sensor_device_attribute_2
  957. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  958. int ix = sensor_attr_2->index;
  959. int fn = sensor_attr_2->nr;
  960. int res;
  961. switch (fn) {
  962. case SYS_PWM:
  963. if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 0) {
  964. res = 255;
  965. } else {
  966. res = data->pwm[ix];
  967. }
  968. break;
  969. case SYS_PWM_FREQ:
  970. res = PWM_FREQ_FROM_REG(data->pwm_freq[ix]);
  971. break;
  972. case SYS_PWM_ENABLE:
  973. if (ix > 3) {
  974. res = 1; /* pwm[5-6] hard-wired to manual mode */
  975. } else {
  976. res = PWM_EN_FROM_REG(data->pwm_config[ix]);
  977. }
  978. break;
  979. case SYS_PWM_RAMP_RATE:
  980. /* Only valid for pwm[1-3] */
  981. res = PWM_RR_FROM_REG(data->pwm_rr[ix > 0], ix);
  982. break;
  983. case SYS_PWM_AUTO_CHANNELS_ZONE:
  984. /* Only valid for pwm[1-3] */
  985. if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
  986. res = PWM_ACZ_FROM_REG(data->pwm_config[ix]);
  987. } else {
  988. res = data->pwm_acz[ix];
  989. }
  990. break;
  991. case SYS_PWM_AUTO_PWM_MIN:
  992. /* Only valid for pwm[1-3] */
  993. if (PWM_OFF_FROM_REG(data->pwm_rr[0], ix)) {
  994. res = data->pwm_min[ix];
  995. } else {
  996. res = 0;
  997. }
  998. break;
  999. case SYS_PWM_AUTO_POINT1_PWM:
  1000. /* Only valid for pwm[1-3] */
  1001. res = data->pwm_min[ix];
  1002. break;
  1003. case SYS_PWM_AUTO_POINT2_PWM:
  1004. /* Only valid for pwm[1-3] */
  1005. res = 255; /* hard-wired */
  1006. break;
  1007. default:
  1008. res = 0;
  1009. dev_dbg(dev, "Unknown function %d.\n", fn);
  1010. }
  1011. return sprintf(buf, "%d\n", res);
  1012. }
  1013. static struct attribute *dme1737_attr_pwm[];
  1014. static void dme1737_chmod_file(struct device*, struct attribute*, mode_t);
  1015. static ssize_t set_pwm(struct device *dev, struct device_attribute *attr,
  1016. const char *buf, size_t count)
  1017. {
  1018. struct dme1737_data *data = dev_get_drvdata(dev);
  1019. struct i2c_client *client = &data->client;
  1020. struct sensor_device_attribute_2
  1021. *sensor_attr_2 = to_sensor_dev_attr_2(attr);
  1022. int ix = sensor_attr_2->index;
  1023. int fn = sensor_attr_2->nr;
  1024. long val = simple_strtol(buf, NULL, 10);
  1025. mutex_lock(&data->update_lock);
  1026. switch (fn) {
  1027. case SYS_PWM:
  1028. data->pwm[ix] = SENSORS_LIMIT(val, 0, 255);
  1029. dme1737_write(client, DME1737_REG_PWM(ix), data->pwm[ix]);
  1030. break;
  1031. case SYS_PWM_FREQ:
  1032. data->pwm_freq[ix] = PWM_FREQ_TO_REG(val, dme1737_read(client,
  1033. DME1737_REG_PWM_FREQ(ix)));
  1034. dme1737_write(client, DME1737_REG_PWM_FREQ(ix),
  1035. data->pwm_freq[ix]);
  1036. break;
  1037. case SYS_PWM_ENABLE:
  1038. /* Only valid for pwm[1-3] */
  1039. if (val < 0 || val > 2) {
  1040. count = -EINVAL;
  1041. dev_warn(dev, "PWM enable %ld not "
  1042. "supported. Choose one of 0, 1, or 2.\n",
  1043. val);
  1044. goto exit;
  1045. }
  1046. /* Refresh the cache */
  1047. data->pwm_config[ix] = dme1737_read(client,
  1048. DME1737_REG_PWM_CONFIG(ix));
  1049. if (val == PWM_EN_FROM_REG(data->pwm_config[ix])) {
  1050. /* Bail out if no change */
  1051. goto exit;
  1052. }
  1053. /* Do some housekeeping if we are currently in auto mode */
  1054. if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
  1055. /* Save the current zone channel assignment */
  1056. data->pwm_acz[ix] = PWM_ACZ_FROM_REG(
  1057. data->pwm_config[ix]);
  1058. /* Save the current ramp rate state and disable it */
  1059. data->pwm_rr[ix > 0] = dme1737_read(client,
  1060. DME1737_REG_PWM_RR(ix > 0));
  1061. data->pwm_rr_en &= ~(1 << ix);
  1062. if (PWM_RR_EN_FROM_REG(data->pwm_rr[ix > 0], ix)) {
  1063. data->pwm_rr_en |= (1 << ix);
  1064. data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(0, ix,
  1065. data->pwm_rr[ix > 0]);
  1066. dme1737_write(client,
  1067. DME1737_REG_PWM_RR(ix > 0),
  1068. data->pwm_rr[ix > 0]);
  1069. }
  1070. }
  1071. /* Set the new PWM mode */
  1072. switch (val) {
  1073. case 0:
  1074. /* Change permissions of pwm[ix] to read-only */
  1075. dme1737_chmod_file(dev, dme1737_attr_pwm[ix],
  1076. S_IRUGO);
  1077. /* Turn fan fully on */
  1078. data->pwm_config[ix] = PWM_EN_TO_REG(0,
  1079. data->pwm_config[ix]);
  1080. dme1737_write(client, DME1737_REG_PWM_CONFIG(ix),
  1081. data->pwm_config[ix]);
  1082. break;
  1083. case 1:
  1084. /* Turn on manual mode */
  1085. data->pwm_config[ix] = PWM_EN_TO_REG(1,
  1086. data->pwm_config[ix]);
  1087. dme1737_write(client, DME1737_REG_PWM_CONFIG(ix),
  1088. data->pwm_config[ix]);
  1089. /* Change permissions of pwm[ix] to read-writeable */
  1090. dme1737_chmod_file(dev, dme1737_attr_pwm[ix],
  1091. S_IRUGO | S_IWUSR);
  1092. break;
  1093. case 2:
  1094. /* Change permissions of pwm[ix] to read-only */
  1095. dme1737_chmod_file(dev, dme1737_attr_pwm[ix],
  1096. S_IRUGO);
  1097. /* Turn on auto mode using the saved zone channel
  1098. * assignment */
  1099. data->pwm_config[ix] = PWM_ACZ_TO_REG(
  1100. data->pwm_acz[ix],
  1101. data->pwm_config[ix]);
  1102. dme1737_write(client, DME1737_REG_PWM_CONFIG(ix),
  1103. data->pwm_config[ix]);
  1104. /* Enable PWM ramp rate if previously enabled */
  1105. if (data->pwm_rr_en & (1 << ix)) {
  1106. data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(1, ix,
  1107. dme1737_read(client,
  1108. DME1737_REG_PWM_RR(ix > 0)));
  1109. dme1737_write(client,
  1110. DME1737_REG_PWM_RR(ix > 0),
  1111. data->pwm_rr[ix > 0]);
  1112. }
  1113. break;
  1114. }
  1115. break;
  1116. case SYS_PWM_RAMP_RATE:
  1117. /* Only valid for pwm[1-3] */
  1118. /* Refresh the cache */
  1119. data->pwm_config[ix] = dme1737_read(client,
  1120. DME1737_REG_PWM_CONFIG(ix));
  1121. data->pwm_rr[ix > 0] = dme1737_read(client,
  1122. DME1737_REG_PWM_RR(ix > 0));
  1123. /* Set the ramp rate value */
  1124. if (val > 0) {
  1125. data->pwm_rr[ix > 0] = PWM_RR_TO_REG(val, ix,
  1126. data->pwm_rr[ix > 0]);
  1127. }
  1128. /* Enable/disable the feature only if the associated PWM
  1129. * output is in automatic mode. */
  1130. if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
  1131. data->pwm_rr[ix > 0] = PWM_RR_EN_TO_REG(val > 0, ix,
  1132. data->pwm_rr[ix > 0]);
  1133. }
  1134. dme1737_write(client, DME1737_REG_PWM_RR(ix > 0),
  1135. data->pwm_rr[ix > 0]);
  1136. break;
  1137. case SYS_PWM_AUTO_CHANNELS_ZONE:
  1138. /* Only valid for pwm[1-3] */
  1139. if (!(val == 1 || val == 2 || val == 4 ||
  1140. val == 6 || val == 7)) {
  1141. count = -EINVAL;
  1142. dev_warn(dev, "PWM auto channels zone %ld "
  1143. "not supported. Choose one of 1, 2, 4, 6, "
  1144. "or 7.\n", val);
  1145. goto exit;
  1146. }
  1147. /* Refresh the cache */
  1148. data->pwm_config[ix] = dme1737_read(client,
  1149. DME1737_REG_PWM_CONFIG(ix));
  1150. if (PWM_EN_FROM_REG(data->pwm_config[ix]) == 2) {
  1151. /* PWM is already in auto mode so update the temp
  1152. * channel assignment */
  1153. data->pwm_config[ix] = PWM_ACZ_TO_REG(val,
  1154. data->pwm_config[ix]);
  1155. dme1737_write(client, DME1737_REG_PWM_CONFIG(ix),
  1156. data->pwm_config[ix]);
  1157. } else {
  1158. /* PWM is not in auto mode so we save the temp
  1159. * channel assignment for later use */
  1160. data->pwm_acz[ix] = val;
  1161. }
  1162. break;
  1163. case SYS_PWM_AUTO_PWM_MIN:
  1164. /* Only valid for pwm[1-3] */
  1165. /* Refresh the cache */
  1166. data->pwm_min[ix] = dme1737_read(client,
  1167. DME1737_REG_PWM_MIN(ix));
  1168. /* There are only 2 values supported for the auto_pwm_min
  1169. * value: 0 or auto_point1_pwm. So if the temperature drops
  1170. * below the auto_point1_temp_hyst value, the fan either turns
  1171. * off or runs at auto_point1_pwm duty-cycle. */
  1172. if (val > ((data->pwm_min[ix] + 1) / 2)) {
  1173. data->pwm_rr[0] = PWM_OFF_TO_REG(1, ix,
  1174. dme1737_read(client,
  1175. DME1737_REG_PWM_RR(0)));
  1176. } else {
  1177. data->pwm_rr[0] = PWM_OFF_TO_REG(0, ix,
  1178. dme1737_read(client,
  1179. DME1737_REG_PWM_RR(0)));
  1180. }
  1181. dme1737_write(client, DME1737_REG_PWM_RR(0),
  1182. data->pwm_rr[0]);
  1183. break;
  1184. case SYS_PWM_AUTO_POINT1_PWM:
  1185. /* Only valid for pwm[1-3] */
  1186. data->pwm_min[ix] = SENSORS_LIMIT(val, 0, 255);
  1187. dme1737_write(client, DME1737_REG_PWM_MIN(ix),
  1188. data->pwm_min[ix]);
  1189. break;
  1190. default:
  1191. dev_dbg(dev, "Unknown function %d.\n", fn);
  1192. }
  1193. exit:
  1194. mutex_unlock(&data->update_lock);
  1195. return count;
  1196. }
  1197. /* ---------------------------------------------------------------------
  1198. * Miscellaneous sysfs attributes
  1199. * --------------------------------------------------------------------- */
  1200. static ssize_t show_vrm(struct device *dev, struct device_attribute *attr,
  1201. char *buf)
  1202. {
  1203. struct i2c_client *client = to_i2c_client(dev);
  1204. struct dme1737_data *data = i2c_get_clientdata(client);
  1205. return sprintf(buf, "%d\n", data->vrm);
  1206. }
  1207. static ssize_t set_vrm(struct device *dev, struct device_attribute *attr,
  1208. const char *buf, size_t count)
  1209. {
  1210. struct dme1737_data *data = dev_get_drvdata(dev);
  1211. long val = simple_strtol(buf, NULL, 10);
  1212. data->vrm = val;
  1213. return count;
  1214. }
  1215. static ssize_t show_vid(struct device *dev, struct device_attribute *attr,
  1216. char *buf)
  1217. {
  1218. struct dme1737_data *data = dme1737_update_device(dev);
  1219. return sprintf(buf, "%d\n", vid_from_reg(data->vid, data->vrm));
  1220. }
  1221. static ssize_t show_name(struct device *dev, struct device_attribute *attr,
  1222. char *buf)
  1223. {
  1224. struct dme1737_data *data = dev_get_drvdata(dev);
  1225. return sprintf(buf, "%s\n", data->client.name);
  1226. }
  1227. /* ---------------------------------------------------------------------
  1228. * Sysfs device attribute defines and structs
  1229. * --------------------------------------------------------------------- */
  1230. /* Voltages 0-6 */
  1231. #define SENSOR_DEVICE_ATTR_IN(ix) \
  1232. static SENSOR_DEVICE_ATTR_2(in##ix##_input, S_IRUGO, \
  1233. show_in, NULL, SYS_IN_INPUT, ix); \
  1234. static SENSOR_DEVICE_ATTR_2(in##ix##_min, S_IRUGO | S_IWUSR, \
  1235. show_in, set_in, SYS_IN_MIN, ix); \
  1236. static SENSOR_DEVICE_ATTR_2(in##ix##_max, S_IRUGO | S_IWUSR, \
  1237. show_in, set_in, SYS_IN_MAX, ix); \
  1238. static SENSOR_DEVICE_ATTR_2(in##ix##_alarm, S_IRUGO, \
  1239. show_in, NULL, SYS_IN_ALARM, ix)
  1240. SENSOR_DEVICE_ATTR_IN(0);
  1241. SENSOR_DEVICE_ATTR_IN(1);
  1242. SENSOR_DEVICE_ATTR_IN(2);
  1243. SENSOR_DEVICE_ATTR_IN(3);
  1244. SENSOR_DEVICE_ATTR_IN(4);
  1245. SENSOR_DEVICE_ATTR_IN(5);
  1246. SENSOR_DEVICE_ATTR_IN(6);
  1247. /* Temperatures 1-3 */
  1248. #define SENSOR_DEVICE_ATTR_TEMP(ix) \
  1249. static SENSOR_DEVICE_ATTR_2(temp##ix##_input, S_IRUGO, \
  1250. show_temp, NULL, SYS_TEMP_INPUT, ix-1); \
  1251. static SENSOR_DEVICE_ATTR_2(temp##ix##_min, S_IRUGO | S_IWUSR, \
  1252. show_temp, set_temp, SYS_TEMP_MIN, ix-1); \
  1253. static SENSOR_DEVICE_ATTR_2(temp##ix##_max, S_IRUGO | S_IWUSR, \
  1254. show_temp, set_temp, SYS_TEMP_MAX, ix-1); \
  1255. static SENSOR_DEVICE_ATTR_2(temp##ix##_offset, S_IRUGO, \
  1256. show_temp, set_temp, SYS_TEMP_OFFSET, ix-1); \
  1257. static SENSOR_DEVICE_ATTR_2(temp##ix##_alarm, S_IRUGO, \
  1258. show_temp, NULL, SYS_TEMP_ALARM, ix-1); \
  1259. static SENSOR_DEVICE_ATTR_2(temp##ix##_fault, S_IRUGO, \
  1260. show_temp, NULL, SYS_TEMP_FAULT, ix-1)
  1261. SENSOR_DEVICE_ATTR_TEMP(1);
  1262. SENSOR_DEVICE_ATTR_TEMP(2);
  1263. SENSOR_DEVICE_ATTR_TEMP(3);
  1264. /* Zones 1-3 */
  1265. #define SENSOR_DEVICE_ATTR_ZONE(ix) \
  1266. static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_channels_temp, S_IRUGO, \
  1267. show_zone, NULL, SYS_ZONE_AUTO_CHANNELS_TEMP, ix-1); \
  1268. static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point1_temp_hyst, S_IRUGO, \
  1269. show_zone, set_zone, SYS_ZONE_AUTO_POINT1_TEMP_HYST, ix-1); \
  1270. static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point1_temp, S_IRUGO, \
  1271. show_zone, set_zone, SYS_ZONE_AUTO_POINT1_TEMP, ix-1); \
  1272. static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point2_temp, S_IRUGO, \
  1273. show_zone, set_zone, SYS_ZONE_AUTO_POINT2_TEMP, ix-1); \
  1274. static SENSOR_DEVICE_ATTR_2(zone##ix##_auto_point3_temp, S_IRUGO, \
  1275. show_zone, set_zone, SYS_ZONE_AUTO_POINT3_TEMP, ix-1)
  1276. SENSOR_DEVICE_ATTR_ZONE(1);
  1277. SENSOR_DEVICE_ATTR_ZONE(2);
  1278. SENSOR_DEVICE_ATTR_ZONE(3);
  1279. /* Fans 1-4 */
  1280. #define SENSOR_DEVICE_ATTR_FAN_1TO4(ix) \
  1281. static SENSOR_DEVICE_ATTR_2(fan##ix##_input, S_IRUGO, \
  1282. show_fan, NULL, SYS_FAN_INPUT, ix-1); \
  1283. static SENSOR_DEVICE_ATTR_2(fan##ix##_min, S_IRUGO | S_IWUSR, \
  1284. show_fan, set_fan, SYS_FAN_MIN, ix-1); \
  1285. static SENSOR_DEVICE_ATTR_2(fan##ix##_alarm, S_IRUGO, \
  1286. show_fan, NULL, SYS_FAN_ALARM, ix-1); \
  1287. static SENSOR_DEVICE_ATTR_2(fan##ix##_type, S_IRUGO | S_IWUSR, \
  1288. show_fan, set_fan, SYS_FAN_TYPE, ix-1)
  1289. SENSOR_DEVICE_ATTR_FAN_1TO4(1);
  1290. SENSOR_DEVICE_ATTR_FAN_1TO4(2);
  1291. SENSOR_DEVICE_ATTR_FAN_1TO4(3);
  1292. SENSOR_DEVICE_ATTR_FAN_1TO4(4);
  1293. /* Fans 5-6 */
  1294. #define SENSOR_DEVICE_ATTR_FAN_5TO6(ix) \
  1295. static SENSOR_DEVICE_ATTR_2(fan##ix##_input, S_IRUGO, \
  1296. show_fan, NULL, SYS_FAN_INPUT, ix-1); \
  1297. static SENSOR_DEVICE_ATTR_2(fan##ix##_min, S_IRUGO | S_IWUSR, \
  1298. show_fan, set_fan, SYS_FAN_MIN, ix-1); \
  1299. static SENSOR_DEVICE_ATTR_2(fan##ix##_alarm, S_IRUGO, \
  1300. show_fan, NULL, SYS_FAN_ALARM, ix-1); \
  1301. static SENSOR_DEVICE_ATTR_2(fan##ix##_max, S_IRUGO | S_IWUSR, \
  1302. show_fan, set_fan, SYS_FAN_MAX, ix-1)
  1303. SENSOR_DEVICE_ATTR_FAN_5TO6(5);
  1304. SENSOR_DEVICE_ATTR_FAN_5TO6(6);
  1305. /* PWMs 1-3 */
  1306. #define SENSOR_DEVICE_ATTR_PWM_1TO3(ix) \
  1307. static SENSOR_DEVICE_ATTR_2(pwm##ix, S_IRUGO, \
  1308. show_pwm, set_pwm, SYS_PWM, ix-1); \
  1309. static SENSOR_DEVICE_ATTR_2(pwm##ix##_freq, S_IRUGO, \
  1310. show_pwm, set_pwm, SYS_PWM_FREQ, ix-1); \
  1311. static SENSOR_DEVICE_ATTR_2(pwm##ix##_enable, S_IRUGO, \
  1312. show_pwm, set_pwm, SYS_PWM_ENABLE, ix-1); \
  1313. static SENSOR_DEVICE_ATTR_2(pwm##ix##_ramp_rate, S_IRUGO, \
  1314. show_pwm, set_pwm, SYS_PWM_RAMP_RATE, ix-1); \
  1315. static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_channels_zone, S_IRUGO, \
  1316. show_pwm, set_pwm, SYS_PWM_AUTO_CHANNELS_ZONE, ix-1); \
  1317. static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_pwm_min, S_IRUGO, \
  1318. show_pwm, set_pwm, SYS_PWM_AUTO_PWM_MIN, ix-1); \
  1319. static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_point1_pwm, S_IRUGO, \
  1320. show_pwm, set_pwm, SYS_PWM_AUTO_POINT1_PWM, ix-1); \
  1321. static SENSOR_DEVICE_ATTR_2(pwm##ix##_auto_point2_pwm, S_IRUGO, \
  1322. show_pwm, NULL, SYS_PWM_AUTO_POINT2_PWM, ix-1)
  1323. SENSOR_DEVICE_ATTR_PWM_1TO3(1);
  1324. SENSOR_DEVICE_ATTR_PWM_1TO3(2);
  1325. SENSOR_DEVICE_ATTR_PWM_1TO3(3);
  1326. /* PWMs 5-6 */
  1327. #define SENSOR_DEVICE_ATTR_PWM_5TO6(ix) \
  1328. static SENSOR_DEVICE_ATTR_2(pwm##ix, S_IRUGO | S_IWUSR, \
  1329. show_pwm, set_pwm, SYS_PWM, ix-1); \
  1330. static SENSOR_DEVICE_ATTR_2(pwm##ix##_freq, S_IRUGO | S_IWUSR, \
  1331. show_pwm, set_pwm, SYS_PWM_FREQ, ix-1); \
  1332. static SENSOR_DEVICE_ATTR_2(pwm##ix##_enable, S_IRUGO, \
  1333. show_pwm, NULL, SYS_PWM_ENABLE, ix-1)
  1334. SENSOR_DEVICE_ATTR_PWM_5TO6(5);
  1335. SENSOR_DEVICE_ATTR_PWM_5TO6(6);
  1336. /* Misc */
  1337. static DEVICE_ATTR(vrm, S_IRUGO | S_IWUSR, show_vrm, set_vrm);
  1338. static DEVICE_ATTR(cpu0_vid, S_IRUGO, show_vid, NULL);
  1339. static DEVICE_ATTR(name, S_IRUGO, show_name, NULL); /* for ISA devices */
  1340. #define SENSOR_DEV_ATTR_IN(ix) \
  1341. &sensor_dev_attr_in##ix##_input.dev_attr.attr, \
  1342. &sensor_dev_attr_in##ix##_min.dev_attr.attr, \
  1343. &sensor_dev_attr_in##ix##_max.dev_attr.attr, \
  1344. &sensor_dev_attr_in##ix##_alarm.dev_attr.attr
  1345. /* These attributes are read-writeable only if the chip is *not* locked */
  1346. #define SENSOR_DEV_ATTR_TEMP_LOCK(ix) \
  1347. &sensor_dev_attr_temp##ix##_offset.dev_attr.attr
  1348. #define SENSOR_DEV_ATTR_TEMP(ix) \
  1349. SENSOR_DEV_ATTR_TEMP_LOCK(ix), \
  1350. &sensor_dev_attr_temp##ix##_input.dev_attr.attr, \
  1351. &sensor_dev_attr_temp##ix##_min.dev_attr.attr, \
  1352. &sensor_dev_attr_temp##ix##_max.dev_attr.attr, \
  1353. &sensor_dev_attr_temp##ix##_alarm.dev_attr.attr, \
  1354. &sensor_dev_attr_temp##ix##_fault.dev_attr.attr
  1355. /* These attributes are read-writeable only if the chip is *not* locked */
  1356. #define SENSOR_DEV_ATTR_ZONE_LOCK(ix) \
  1357. &sensor_dev_attr_zone##ix##_auto_point1_temp_hyst.dev_attr.attr, \
  1358. &sensor_dev_attr_zone##ix##_auto_point1_temp.dev_attr.attr, \
  1359. &sensor_dev_attr_zone##ix##_auto_point2_temp.dev_attr.attr, \
  1360. &sensor_dev_attr_zone##ix##_auto_point3_temp.dev_attr.attr
  1361. #define SENSOR_DEV_ATTR_ZONE(ix) \
  1362. SENSOR_DEV_ATTR_ZONE_LOCK(ix), \
  1363. &sensor_dev_attr_zone##ix##_auto_channels_temp.dev_attr.attr
  1364. #define SENSOR_DEV_ATTR_FAN_1TO4(ix) \
  1365. &sensor_dev_attr_fan##ix##_input.dev_attr.attr, \
  1366. &sensor_dev_attr_fan##ix##_min.dev_attr.attr, \
  1367. &sensor_dev_attr_fan##ix##_alarm.dev_attr.attr, \
  1368. &sensor_dev_attr_fan##ix##_type.dev_attr.attr
  1369. #define SENSOR_DEV_ATTR_FAN_5TO6(ix) \
  1370. &sensor_dev_attr_fan##ix##_input.dev_attr.attr, \
  1371. &sensor_dev_attr_fan##ix##_min.dev_attr.attr, \
  1372. &sensor_dev_attr_fan##ix##_alarm.dev_attr.attr, \
  1373. &sensor_dev_attr_fan##ix##_max.dev_attr.attr
  1374. /* These attributes are read-writeable only if the chip is *not* locked */
  1375. #define SENSOR_DEV_ATTR_PWM_1TO3_LOCK(ix) \
  1376. &sensor_dev_attr_pwm##ix##_freq.dev_attr.attr, \
  1377. &sensor_dev_attr_pwm##ix##_enable.dev_attr.attr, \
  1378. &sensor_dev_attr_pwm##ix##_ramp_rate.dev_attr.attr, \
  1379. &sensor_dev_attr_pwm##ix##_auto_channels_zone.dev_attr.attr, \
  1380. &sensor_dev_attr_pwm##ix##_auto_pwm_min.dev_attr.attr, \
  1381. &sensor_dev_attr_pwm##ix##_auto_point1_pwm.dev_attr.attr
  1382. #define SENSOR_DEV_ATTR_PWM_1TO3(ix) \
  1383. SENSOR_DEV_ATTR_PWM_1TO3_LOCK(ix), \
  1384. &sensor_dev_attr_pwm##ix.dev_attr.attr, \
  1385. &sensor_dev_attr_pwm##ix##_auto_point2_pwm.dev_attr.attr
  1386. /* These attributes are read-writeable only if the chip is *not* locked */
  1387. #define SENSOR_DEV_ATTR_PWM_5TO6_LOCK(ix) \
  1388. &sensor_dev_attr_pwm##ix.dev_attr.attr, \
  1389. &sensor_dev_attr_pwm##ix##_freq.dev_attr.attr
  1390. #define SENSOR_DEV_ATTR_PWM_5TO6(ix) \
  1391. SENSOR_DEV_ATTR_PWM_5TO6_LOCK(ix), \
  1392. &sensor_dev_attr_pwm##ix##_enable.dev_attr.attr
  1393. /* This struct holds all the attributes that are always present and need to be
  1394. * created unconditionally. The attributes that need modification of their
  1395. * permissions are created read-only and write permissions are added or removed
  1396. * on the fly when required */
  1397. static struct attribute *dme1737_attr[] ={
  1398. /* Voltages */
  1399. SENSOR_DEV_ATTR_IN(0),
  1400. SENSOR_DEV_ATTR_IN(1),
  1401. SENSOR_DEV_ATTR_IN(2),
  1402. SENSOR_DEV_ATTR_IN(3),
  1403. SENSOR_DEV_ATTR_IN(4),
  1404. SENSOR_DEV_ATTR_IN(5),
  1405. SENSOR_DEV_ATTR_IN(6),
  1406. /* Temperatures */
  1407. SENSOR_DEV_ATTR_TEMP(1),
  1408. SENSOR_DEV_ATTR_TEMP(2),
  1409. SENSOR_DEV_ATTR_TEMP(3),
  1410. /* Zones */
  1411. SENSOR_DEV_ATTR_ZONE(1),
  1412. SENSOR_DEV_ATTR_ZONE(2),
  1413. SENSOR_DEV_ATTR_ZONE(3),
  1414. /* Misc */
  1415. &dev_attr_vrm.attr,
  1416. &dev_attr_cpu0_vid.attr,
  1417. NULL
  1418. };
  1419. static const struct attribute_group dme1737_group = {
  1420. .attrs = dme1737_attr,
  1421. };
  1422. /* The following structs hold the PWM attributes, some of which are optional.
  1423. * Their creation depends on the chip configuration which is determined during
  1424. * module load. */
  1425. static struct attribute *dme1737_attr_pwm1[] = {
  1426. SENSOR_DEV_ATTR_PWM_1TO3(1),
  1427. NULL
  1428. };
  1429. static struct attribute *dme1737_attr_pwm2[] = {
  1430. SENSOR_DEV_ATTR_PWM_1TO3(2),
  1431. NULL
  1432. };
  1433. static struct attribute *dme1737_attr_pwm3[] = {
  1434. SENSOR_DEV_ATTR_PWM_1TO3(3),
  1435. NULL
  1436. };
  1437. static struct attribute *dme1737_attr_pwm5[] = {
  1438. SENSOR_DEV_ATTR_PWM_5TO6(5),
  1439. NULL
  1440. };
  1441. static struct attribute *dme1737_attr_pwm6[] = {
  1442. SENSOR_DEV_ATTR_PWM_5TO6(6),
  1443. NULL
  1444. };
  1445. static const struct attribute_group dme1737_pwm_group[] = {
  1446. { .attrs = dme1737_attr_pwm1 },
  1447. { .attrs = dme1737_attr_pwm2 },
  1448. { .attrs = dme1737_attr_pwm3 },
  1449. { .attrs = NULL },
  1450. { .attrs = dme1737_attr_pwm5 },
  1451. { .attrs = dme1737_attr_pwm6 },
  1452. };
  1453. /* The following structs hold the fan attributes, some of which are optional.
  1454. * Their creation depends on the chip configuration which is determined during
  1455. * module load. */
  1456. static struct attribute *dme1737_attr_fan1[] = {
  1457. SENSOR_DEV_ATTR_FAN_1TO4(1),
  1458. NULL
  1459. };
  1460. static struct attribute *dme1737_attr_fan2[] = {
  1461. SENSOR_DEV_ATTR_FAN_1TO4(2),
  1462. NULL
  1463. };
  1464. static struct attribute *dme1737_attr_fan3[] = {
  1465. SENSOR_DEV_ATTR_FAN_1TO4(3),
  1466. NULL
  1467. };
  1468. static struct attribute *dme1737_attr_fan4[] = {
  1469. SENSOR_DEV_ATTR_FAN_1TO4(4),
  1470. NULL
  1471. };
  1472. static struct attribute *dme1737_attr_fan5[] = {
  1473. SENSOR_DEV_ATTR_FAN_5TO6(5),
  1474. NULL
  1475. };
  1476. static struct attribute *dme1737_attr_fan6[] = {
  1477. SENSOR_DEV_ATTR_FAN_5TO6(6),
  1478. NULL
  1479. };
  1480. static const struct attribute_group dme1737_fan_group[] = {
  1481. { .attrs = dme1737_attr_fan1 },
  1482. { .attrs = dme1737_attr_fan2 },
  1483. { .attrs = dme1737_attr_fan3 },
  1484. { .attrs = dme1737_attr_fan4 },
  1485. { .attrs = dme1737_attr_fan5 },
  1486. { .attrs = dme1737_attr_fan6 },
  1487. };
  1488. /* The permissions of all of the following attributes are changed to read-
  1489. * writeable if the chip is *not* locked. Otherwise they stay read-only. */
  1490. static struct attribute *dme1737_attr_lock[] = {
  1491. /* Temperatures */
  1492. SENSOR_DEV_ATTR_TEMP_LOCK(1),
  1493. SENSOR_DEV_ATTR_TEMP_LOCK(2),
  1494. SENSOR_DEV_ATTR_TEMP_LOCK(3),
  1495. /* Zones */
  1496. SENSOR_DEV_ATTR_ZONE_LOCK(1),
  1497. SENSOR_DEV_ATTR_ZONE_LOCK(2),
  1498. SENSOR_DEV_ATTR_ZONE_LOCK(3),
  1499. NULL
  1500. };
  1501. static const struct attribute_group dme1737_lock_group = {
  1502. .attrs = dme1737_attr_lock,
  1503. };
  1504. /* The permissions of the following PWM attributes are changed to read-
  1505. * writeable if the chip is *not* locked and the respective PWM is available.
  1506. * Otherwise they stay read-only. */
  1507. static struct attribute *dme1737_attr_pwm1_lock[] = {
  1508. SENSOR_DEV_ATTR_PWM_1TO3_LOCK(1),
  1509. NULL
  1510. };
  1511. static struct attribute *dme1737_attr_pwm2_lock[] = {
  1512. SENSOR_DEV_ATTR_PWM_1TO3_LOCK(2),
  1513. NULL
  1514. };
  1515. static struct attribute *dme1737_attr_pwm3_lock[] = {
  1516. SENSOR_DEV_ATTR_PWM_1TO3_LOCK(3),
  1517. NULL
  1518. };
  1519. static struct attribute *dme1737_attr_pwm5_lock[] = {
  1520. SENSOR_DEV_ATTR_PWM_5TO6_LOCK(5),
  1521. NULL
  1522. };
  1523. static struct attribute *dme1737_attr_pwm6_lock[] = {
  1524. SENSOR_DEV_ATTR_PWM_5TO6_LOCK(6),
  1525. NULL
  1526. };
  1527. static const struct attribute_group dme1737_pwm_lock_group[] = {
  1528. { .attrs = dme1737_attr_pwm1_lock },
  1529. { .attrs = dme1737_attr_pwm2_lock },
  1530. { .attrs = dme1737_attr_pwm3_lock },
  1531. { .attrs = NULL },
  1532. { .attrs = dme1737_attr_pwm5_lock },
  1533. { .attrs = dme1737_attr_pwm6_lock },
  1534. };
  1535. /* Pwm[1-3] are read-writeable if the associated pwm is in manual mode and the
  1536. * chip is not locked. Otherwise they are read-only. */
  1537. static struct attribute *dme1737_attr_pwm[] = {
  1538. &sensor_dev_attr_pwm1.dev_attr.attr,
  1539. &sensor_dev_attr_pwm2.dev_attr.attr,
  1540. &sensor_dev_attr_pwm3.dev_attr.attr,
  1541. };
  1542. /* ---------------------------------------------------------------------
  1543. * Super-IO functions
  1544. * --------------------------------------------------------------------- */
  1545. static inline void dme1737_sio_enter(int sio_cip)
  1546. {
  1547. outb(0x55, sio_cip);
  1548. }
  1549. static inline void dme1737_sio_exit(int sio_cip)
  1550. {
  1551. outb(0xaa, sio_cip);
  1552. }
  1553. static inline int dme1737_sio_inb(int sio_cip, int reg)
  1554. {
  1555. outb(reg, sio_cip);
  1556. return inb(sio_cip + 1);
  1557. }
  1558. static inline void dme1737_sio_outb(int sio_cip, int reg, int val)
  1559. {
  1560. outb(reg, sio_cip);
  1561. outb(val, sio_cip + 1);
  1562. }
  1563. /* ---------------------------------------------------------------------
  1564. * Device initialization
  1565. * --------------------------------------------------------------------- */
  1566. static int dme1737_i2c_get_features(int, struct dme1737_data*);
  1567. static void dme1737_chmod_file(struct device *dev,
  1568. struct attribute *attr, mode_t mode)
  1569. {
  1570. if (sysfs_chmod_file(&dev->kobj, attr, mode)) {
  1571. dev_warn(dev, "Failed to change permissions of %s.\n",
  1572. attr->name);
  1573. }
  1574. }
  1575. static void dme1737_chmod_group(struct device *dev,
  1576. const struct attribute_group *group,
  1577. mode_t mode)
  1578. {
  1579. struct attribute **attr;
  1580. for (attr = group->attrs; *attr; attr++) {
  1581. dme1737_chmod_file(dev, *attr, mode);
  1582. }
  1583. }
  1584. static void dme1737_remove_files(struct device *dev)
  1585. {
  1586. struct dme1737_data *data = dev_get_drvdata(dev);
  1587. int ix;
  1588. for (ix = 0; ix < ARRAY_SIZE(dme1737_fan_group); ix++) {
  1589. if (data->has_fan & (1 << ix)) {
  1590. sysfs_remove_group(&dev->kobj,
  1591. &dme1737_fan_group[ix]);
  1592. }
  1593. }
  1594. for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_group); ix++) {
  1595. if (data->has_pwm & (1 << ix)) {
  1596. sysfs_remove_group(&dev->kobj,
  1597. &dme1737_pwm_group[ix]);
  1598. }
  1599. }
  1600. sysfs_remove_group(&dev->kobj, &dme1737_group);
  1601. if (!data->client.driver) {
  1602. sysfs_remove_file(&dev->kobj, &dev_attr_name.attr);
  1603. }
  1604. }
  1605. static int dme1737_create_files(struct device *dev)
  1606. {
  1607. struct dme1737_data *data = dev_get_drvdata(dev);
  1608. int err, ix;
  1609. /* Create a name attribute for ISA devices */
  1610. if (!data->client.driver &&
  1611. (err = sysfs_create_file(&dev->kobj, &dev_attr_name.attr))) {
  1612. goto exit;
  1613. }
  1614. /* Create standard sysfs attributes */
  1615. if ((err = sysfs_create_group(&dev->kobj, &dme1737_group))) {
  1616. goto exit_remove;
  1617. }
  1618. /* Create fan sysfs attributes */
  1619. for (ix = 0; ix < ARRAY_SIZE(dme1737_fan_group); ix++) {
  1620. if (data->has_fan & (1 << ix)) {
  1621. if ((err = sysfs_create_group(&dev->kobj,
  1622. &dme1737_fan_group[ix]))) {
  1623. goto exit_remove;
  1624. }
  1625. }
  1626. }
  1627. /* Create PWM sysfs attributes */
  1628. for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_group); ix++) {
  1629. if (data->has_pwm & (1 << ix)) {
  1630. if ((err = sysfs_create_group(&dev->kobj,
  1631. &dme1737_pwm_group[ix]))) {
  1632. goto exit_remove;
  1633. }
  1634. }
  1635. }
  1636. /* Inform if the device is locked. Otherwise change the permissions of
  1637. * selected attributes from read-only to read-writeable. */
  1638. if (data->config & 0x02) {
  1639. dev_info(dev, "Device is locked. Some attributes "
  1640. "will be read-only.\n");
  1641. } else {
  1642. /* Change permissions of standard attributes */
  1643. dme1737_chmod_group(dev, &dme1737_lock_group,
  1644. S_IRUGO | S_IWUSR);
  1645. /* Change permissions of PWM attributes */
  1646. for (ix = 0; ix < ARRAY_SIZE(dme1737_pwm_lock_group); ix++) {
  1647. if (data->has_pwm & (1 << ix)) {
  1648. dme1737_chmod_group(dev,
  1649. &dme1737_pwm_lock_group[ix],
  1650. S_IRUGO | S_IWUSR);
  1651. }
  1652. }
  1653. /* Change permissions of pwm[1-3] if in manual mode */
  1654. for (ix = 0; ix < 3; ix++) {
  1655. if ((data->has_pwm & (1 << ix)) &&
  1656. (PWM_EN_FROM_REG(data->pwm_config[ix]) == 1)) {
  1657. dme1737_chmod_file(dev,
  1658. dme1737_attr_pwm[ix],
  1659. S_IRUGO | S_IWUSR);
  1660. }
  1661. }
  1662. }
  1663. return 0;
  1664. exit_remove:
  1665. dme1737_remove_files(dev);
  1666. exit:
  1667. return err;
  1668. }
  1669. static int dme1737_init_device(struct device *dev)
  1670. {
  1671. struct dme1737_data *data = dev_get_drvdata(dev);
  1672. struct i2c_client *client = &data->client;
  1673. int ix;
  1674. u8 reg;
  1675. data->config = dme1737_read(client, DME1737_REG_CONFIG);
  1676. /* Inform if part is not monitoring/started */
  1677. if (!(data->config & 0x01)) {
  1678. if (!force_start) {
  1679. dev_err(dev, "Device is not monitoring. "
  1680. "Use the force_start load parameter to "
  1681. "override.\n");
  1682. return -EFAULT;
  1683. }
  1684. /* Force monitoring */
  1685. data->config |= 0x01;
  1686. dme1737_write(client, DME1737_REG_CONFIG, data->config);
  1687. }
  1688. /* Inform if part is not ready */
  1689. if (!(data->config & 0x04)) {
  1690. dev_err(dev, "Device is not ready.\n");
  1691. return -EFAULT;
  1692. }
  1693. /* Determine which optional fan and pwm features are enabled/present */
  1694. if (client->driver) { /* I2C chip */
  1695. data->config2 = dme1737_read(client, DME1737_REG_CONFIG2);
  1696. /* Check if optional fan3 input is enabled */
  1697. if (data->config2 & 0x04) {
  1698. data->has_fan |= (1 << 2);
  1699. }
  1700. /* Fan4 and pwm3 are only available if the client's I2C address
  1701. * is the default 0x2e. Otherwise the I/Os associated with
  1702. * these functions are used for addr enable/select. */
  1703. if (data->client.addr == 0x2e) {
  1704. data->has_fan |= (1 << 3);
  1705. data->has_pwm |= (1 << 2);
  1706. }
  1707. /* Determine which of the optional fan[5-6] and pwm[5-6]
  1708. * features are enabled. For this, we need to query the runtime
  1709. * registers through the Super-IO LPC interface. Try both
  1710. * config ports 0x2e and 0x4e. */
  1711. if (dme1737_i2c_get_features(0x2e, data) &&
  1712. dme1737_i2c_get_features(0x4e, data)) {
  1713. dev_warn(dev, "Failed to query Super-IO for optional "
  1714. "features.\n");
  1715. }
  1716. } else { /* ISA chip */
  1717. /* Fan3 and pwm3 are always available. Fan[4-5] and pwm[5-6]
  1718. * don't exist in the ISA chip. */
  1719. data->has_fan |= (1 << 2);
  1720. data->has_pwm |= (1 << 2);
  1721. }
  1722. /* Fan1, fan2, pwm1, and pwm2 are always present */
  1723. data->has_fan |= 0x03;
  1724. data->has_pwm |= 0x03;
  1725. dev_info(dev, "Optional features: pwm3=%s, pwm5=%s, pwm6=%s, "
  1726. "fan3=%s, fan4=%s, fan5=%s, fan6=%s.\n",
  1727. (data->has_pwm & (1 << 2)) ? "yes" : "no",
  1728. (data->has_pwm & (1 << 4)) ? "yes" : "no",
  1729. (data->has_pwm & (1 << 5)) ? "yes" : "no",
  1730. (data->has_fan & (1 << 2)) ? "yes" : "no",
  1731. (data->has_fan & (1 << 3)) ? "yes" : "no",
  1732. (data->has_fan & (1 << 4)) ? "yes" : "no",
  1733. (data->has_fan & (1 << 5)) ? "yes" : "no");
  1734. reg = dme1737_read(client, DME1737_REG_TACH_PWM);
  1735. /* Inform if fan-to-pwm mapping differs from the default */
  1736. if (client->driver && reg != 0xa4) { /* I2C chip */
  1737. dev_warn(dev, "Non-standard fan to pwm mapping: "
  1738. "fan1->pwm%d, fan2->pwm%d, fan3->pwm%d, "
  1739. "fan4->pwm%d. Please report to the driver "
  1740. "maintainer.\n",
  1741. (reg & 0x03) + 1, ((reg >> 2) & 0x03) + 1,
  1742. ((reg >> 4) & 0x03) + 1, ((reg >> 6) & 0x03) + 1);
  1743. } else if (!client->driver && reg != 0x24) { /* ISA chip */
  1744. dev_warn(dev, "Non-standard fan to pwm mapping: "
  1745. "fan1->pwm%d, fan2->pwm%d, fan3->pwm%d. "
  1746. "Please report to the driver maintainer.\n",
  1747. (reg & 0x03) + 1, ((reg >> 2) & 0x03) + 1,
  1748. ((reg >> 4) & 0x03) + 1);
  1749. }
  1750. /* Switch pwm[1-3] to manual mode if they are currently disabled and
  1751. * set the duty-cycles to 0% (which is identical to the PWMs being
  1752. * disabled). */
  1753. if (!(data->config & 0x02)) {
  1754. for (ix = 0; ix < 3; ix++) {
  1755. data->pwm_config[ix] = dme1737_read(client,
  1756. DME1737_REG_PWM_CONFIG(ix));
  1757. if ((data->has_pwm & (1 << ix)) &&
  1758. (PWM_EN_FROM_REG(data->pwm_config[ix]) == -1)) {
  1759. dev_info(dev, "Switching pwm%d to "
  1760. "manual mode.\n", ix + 1);
  1761. data->pwm_config[ix] = PWM_EN_TO_REG(1,
  1762. data->pwm_config[ix]);
  1763. dme1737_write(client, DME1737_REG_PWM(ix), 0);
  1764. dme1737_write(client,
  1765. DME1737_REG_PWM_CONFIG(ix),
  1766. data->pwm_config[ix]);
  1767. }
  1768. }
  1769. }
  1770. /* Initialize the default PWM auto channels zone (acz) assignments */
  1771. data->pwm_acz[0] = 1; /* pwm1 -> zone1 */
  1772. data->pwm_acz[1] = 2; /* pwm2 -> zone2 */
  1773. data->pwm_acz[2] = 4; /* pwm3 -> zone3 */
  1774. /* Set VRM */
  1775. data->vrm = vid_which_vrm();
  1776. return 0;
  1777. }
  1778. /* ---------------------------------------------------------------------
  1779. * I2C device detection and registration
  1780. * --------------------------------------------------------------------- */
  1781. static struct i2c_driver dme1737_i2c_driver;
  1782. static int dme1737_i2c_get_features(int sio_cip, struct dme1737_data *data)
  1783. {
  1784. int err = 0, reg;
  1785. u16 addr;
  1786. dme1737_sio_enter(sio_cip);
  1787. /* Check device ID
  1788. * The DME1737 can return either 0x78 or 0x77 as its device ID. */
  1789. reg = dme1737_sio_inb(sio_cip, 0x20);
  1790. if (!(reg == 0x77 || reg == 0x78)) {
  1791. err = -ENODEV;
  1792. goto exit;
  1793. }
  1794. /* Select logical device A (runtime registers) */
  1795. dme1737_sio_outb(sio_cip, 0x07, 0x0a);
  1796. /* Get the base address of the runtime registers */
  1797. if (!(addr = (dme1737_sio_inb(sio_cip, 0x60) << 8) |
  1798. dme1737_sio_inb(sio_cip, 0x61))) {
  1799. err = -ENODEV;
  1800. goto exit;
  1801. }
  1802. /* Read the runtime registers to determine which optional features
  1803. * are enabled and available. Bits [3:2] of registers 0x43-0x46 are set
  1804. * to '10' if the respective feature is enabled. */
  1805. if ((inb(addr + 0x43) & 0x0c) == 0x08) { /* fan6 */
  1806. data->has_fan |= (1 << 5);
  1807. }
  1808. if ((inb(addr + 0x44) & 0x0c) == 0x08) { /* pwm6 */
  1809. data->has_pwm |= (1 << 5);
  1810. }
  1811. if ((inb(addr + 0x45) & 0x0c) == 0x08) { /* fan5 */
  1812. data->has_fan |= (1 << 4);
  1813. }
  1814. if ((inb(addr + 0x46) & 0x0c) == 0x08) { /* pwm5 */
  1815. data->has_pwm |= (1 << 4);
  1816. }
  1817. exit:
  1818. dme1737_sio_exit(sio_cip);
  1819. return err;
  1820. }
  1821. static int dme1737_i2c_detect(struct i2c_adapter *adapter, int address,
  1822. int kind)
  1823. {
  1824. u8 company, verstep = 0;
  1825. struct i2c_client *client;
  1826. struct dme1737_data *data;
  1827. struct device *dev;
  1828. int err = 0;
  1829. const char *name;
  1830. if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
  1831. goto exit;
  1832. }
  1833. if (!(data = kzalloc(sizeof(struct dme1737_data), GFP_KERNEL))) {
  1834. err = -ENOMEM;
  1835. goto exit;
  1836. }
  1837. client = &data->client;
  1838. i2c_set_clientdata(client, data);
  1839. client->addr = address;
  1840. client->adapter = adapter;
  1841. client->driver = &dme1737_i2c_driver;
  1842. dev = &client->dev;
  1843. /* A negative kind means that the driver was loaded with no force
  1844. * parameter (default), so we must identify the chip. */
  1845. if (kind < 0) {
  1846. company = dme1737_read(client, DME1737_REG_COMPANY);
  1847. verstep = dme1737_read(client, DME1737_REG_VERSTEP);
  1848. if (!((company == DME1737_COMPANY_SMSC) &&
  1849. ((verstep & DME1737_VERSTEP_MASK) == DME1737_VERSTEP))) {
  1850. err = -ENODEV;
  1851. goto exit_kfree;
  1852. }
  1853. }
  1854. kind = dme1737;
  1855. name = "dme1737";
  1856. /* Fill in the remaining client fields and put it into the global
  1857. * list */
  1858. strlcpy(client->name, name, I2C_NAME_SIZE);
  1859. mutex_init(&data->update_lock);
  1860. /* Tell the I2C layer a new client has arrived */
  1861. if ((err = i2c_attach_client(client))) {
  1862. goto exit_kfree;
  1863. }
  1864. dev_info(dev, "Found a DME1737 chip at 0x%02x (rev 0x%02x).\n",
  1865. client->addr, verstep);
  1866. /* Initialize the DME1737 chip */
  1867. if ((err = dme1737_init_device(dev))) {
  1868. dev_err(dev, "Failed to initialize device.\n");
  1869. goto exit_detach;
  1870. }
  1871. /* Create sysfs files */
  1872. if ((err = dme1737_create_files(dev))) {
  1873. dev_err(dev, "Failed to create sysfs files.\n");
  1874. goto exit_detach;
  1875. }
  1876. /* Register device */
  1877. data->hwmon_dev = hwmon_device_register(dev);
  1878. if (IS_ERR(data->hwmon_dev)) {
  1879. dev_err(dev, "Failed to register device.\n");
  1880. err = PTR_ERR(data->hwmon_dev);
  1881. goto exit_remove;
  1882. }
  1883. return 0;
  1884. exit_remove:
  1885. dme1737_remove_files(dev);
  1886. exit_detach:
  1887. i2c_detach_client(client);
  1888. exit_kfree:
  1889. kfree(data);
  1890. exit:
  1891. return err;
  1892. }
  1893. static int dme1737_i2c_attach_adapter(struct i2c_adapter *adapter)
  1894. {
  1895. if (!(adapter->class & I2C_CLASS_HWMON)) {
  1896. return 0;
  1897. }
  1898. return i2c_probe(adapter, &addr_data, dme1737_i2c_detect);
  1899. }
  1900. static int dme1737_i2c_detach_client(struct i2c_client *client)
  1901. {
  1902. struct dme1737_data *data = i2c_get_clientdata(client);
  1903. int err;
  1904. hwmon_device_unregister(data->hwmon_dev);
  1905. dme1737_remove_files(&client->dev);
  1906. if ((err = i2c_detach_client(client))) {
  1907. return err;
  1908. }
  1909. kfree(data);
  1910. return 0;
  1911. }
  1912. static struct i2c_driver dme1737_i2c_driver = {
  1913. .driver = {
  1914. .name = "dme1737",
  1915. },
  1916. .attach_adapter = dme1737_i2c_attach_adapter,
  1917. .detach_client = dme1737_i2c_detach_client,
  1918. };
  1919. /* ---------------------------------------------------------------------
  1920. * ISA device detection and registration
  1921. * --------------------------------------------------------------------- */
  1922. static int __init dme1737_isa_detect(int sio_cip, unsigned short *addr)
  1923. {
  1924. int err = 0, reg;
  1925. unsigned short base_addr;
  1926. dme1737_sio_enter(sio_cip);
  1927. /* Check device ID
  1928. * We currently know about SCH3112 (0x7c), SCH3114 (0x7d), and
  1929. * SCH3116 (0x7f). */
  1930. reg = force_id ? force_id : dme1737_sio_inb(sio_cip, 0x20);
  1931. if (!(reg == 0x7c || reg == 0x7d || reg == 0x7f)) {
  1932. err = -ENODEV;
  1933. goto exit;
  1934. }
  1935. /* Select logical device A (runtime registers) */
  1936. dme1737_sio_outb(sio_cip, 0x07, 0x0a);
  1937. /* Get the base address of the runtime registers */
  1938. if (!(base_addr = (dme1737_sio_inb(sio_cip, 0x60) << 8) |
  1939. dme1737_sio_inb(sio_cip, 0x61))) {
  1940. printk(KERN_ERR "dme1737: Base address not set.\n");
  1941. err = -ENODEV;
  1942. goto exit;
  1943. }
  1944. /* Access to the hwmon registers is through an index/data register
  1945. * pair located at offset 0x70/0x71. */
  1946. *addr = base_addr + 0x70;
  1947. exit:
  1948. dme1737_sio_exit(sio_cip);
  1949. return err;
  1950. }
  1951. static int __init dme1737_isa_device_add(unsigned short addr)
  1952. {
  1953. struct resource res = {
  1954. .start = addr,
  1955. .end = addr + DME1737_EXTENT - 1,
  1956. .name = "dme1737",
  1957. .flags = IORESOURCE_IO,
  1958. };
  1959. int err;
  1960. if (!(pdev = platform_device_alloc("dme1737", addr))) {
  1961. printk(KERN_ERR "dme1737: Failed to allocate device.\n");
  1962. err = -ENOMEM;
  1963. goto exit;
  1964. }
  1965. if ((err = platform_device_add_resources(pdev, &res, 1))) {
  1966. printk(KERN_ERR "dme1737: Failed to add device resource "
  1967. "(err = %d).\n", err);
  1968. goto exit_device_put;
  1969. }
  1970. if ((err = platform_device_add(pdev))) {
  1971. printk(KERN_ERR "dme1737: Failed to add device (err = %d).\n",
  1972. err);
  1973. goto exit_device_put;
  1974. }
  1975. return 0;
  1976. exit_device_put:
  1977. platform_device_put(pdev);
  1978. pdev = NULL;
  1979. exit:
  1980. return err;
  1981. }
  1982. static int __devinit dme1737_isa_probe(struct platform_device *pdev)
  1983. {
  1984. u8 company, device;
  1985. struct resource *res;
  1986. struct i2c_client *client;
  1987. struct dme1737_data *data;
  1988. struct device *dev = &pdev->dev;
  1989. int err;
  1990. res = platform_get_resource(pdev, IORESOURCE_IO, 0);
  1991. if (!request_region(res->start, DME1737_EXTENT, "dme1737")) {
  1992. dev_err(dev, "Failed to request region 0x%04x-0x%04x.\n",
  1993. (unsigned short)res->start,
  1994. (unsigned short)res->start + DME1737_EXTENT - 1);
  1995. err = -EBUSY;
  1996. goto exit;
  1997. }
  1998. if (!(data = kzalloc(sizeof(struct dme1737_data), GFP_KERNEL))) {
  1999. err = -ENOMEM;
  2000. goto exit_release_region;
  2001. }
  2002. client = &data->client;
  2003. i2c_set_clientdata(client, data);
  2004. client->addr = res->start;
  2005. platform_set_drvdata(pdev, data);
  2006. company = dme1737_read(client, DME1737_REG_COMPANY);
  2007. device = dme1737_read(client, DME1737_REG_DEVICE);
  2008. if (!((company == DME1737_COMPANY_SMSC) &&
  2009. (device == SCH311X_DEVICE))) {
  2010. err = -ENODEV;
  2011. goto exit_kfree;
  2012. }
  2013. /* Fill in the remaining client fields and initialize the mutex */
  2014. strlcpy(client->name, "sch311x", I2C_NAME_SIZE);
  2015. mutex_init(&data->update_lock);
  2016. dev_info(dev, "Found a SCH311x chip at 0x%04x\n", client->addr);
  2017. /* Initialize the chip */
  2018. if ((err = dme1737_init_device(dev))) {
  2019. dev_err(dev, "Failed to initialize device.\n");
  2020. goto exit_kfree;
  2021. }
  2022. /* Create sysfs files */
  2023. if ((err = dme1737_create_files(dev))) {
  2024. dev_err(dev, "Failed to create sysfs files.\n");
  2025. goto exit_kfree;
  2026. }
  2027. /* Register device */
  2028. data->hwmon_dev = hwmon_device_register(dev);
  2029. if (IS_ERR(data->hwmon_dev)) {
  2030. dev_err(dev, "Failed to register device.\n");
  2031. err = PTR_ERR(data->hwmon_dev);
  2032. goto exit_remove_files;
  2033. }
  2034. return 0;
  2035. exit_remove_files:
  2036. dme1737_remove_files(dev);
  2037. exit_kfree:
  2038. platform_set_drvdata(pdev, NULL);
  2039. kfree(data);
  2040. exit_release_region:
  2041. release_region(res->start, DME1737_EXTENT);
  2042. exit:
  2043. return err;
  2044. }
  2045. static int __devexit dme1737_isa_remove(struct platform_device *pdev)
  2046. {
  2047. struct dme1737_data *data = platform_get_drvdata(pdev);
  2048. hwmon_device_unregister(data->hwmon_dev);
  2049. dme1737_remove_files(&pdev->dev);
  2050. release_region(data->client.addr, DME1737_EXTENT);
  2051. platform_set_drvdata(pdev, NULL);
  2052. kfree(data);
  2053. return 0;
  2054. }
  2055. static struct platform_driver dme1737_isa_driver = {
  2056. .driver = {
  2057. .owner = THIS_MODULE,
  2058. .name = "dme1737",
  2059. },
  2060. .probe = dme1737_isa_probe,
  2061. .remove = __devexit_p(dme1737_isa_remove),
  2062. };
  2063. /* ---------------------------------------------------------------------
  2064. * Module initialization and cleanup
  2065. * --------------------------------------------------------------------- */
  2066. static int __init dme1737_init(void)
  2067. {
  2068. int err;
  2069. unsigned short addr;
  2070. if ((err = i2c_add_driver(&dme1737_i2c_driver))) {
  2071. goto exit;
  2072. }
  2073. if (dme1737_isa_detect(0x2e, &addr) &&
  2074. dme1737_isa_detect(0x4e, &addr)) {
  2075. /* Return 0 if we didn't find an ISA device */
  2076. return 0;
  2077. }
  2078. if ((err = platform_driver_register(&dme1737_isa_driver))) {
  2079. goto exit_del_i2c_driver;
  2080. }
  2081. /* Sets global pdev as a side effect */
  2082. if ((err = dme1737_isa_device_add(addr))) {
  2083. goto exit_del_isa_driver;
  2084. }
  2085. return 0;
  2086. exit_del_isa_driver:
  2087. platform_driver_unregister(&dme1737_isa_driver);
  2088. exit_del_i2c_driver:
  2089. i2c_del_driver(&dme1737_i2c_driver);
  2090. exit:
  2091. return err;
  2092. }
  2093. static void __exit dme1737_exit(void)
  2094. {
  2095. if (pdev) {
  2096. platform_device_unregister(pdev);
  2097. platform_driver_unregister(&dme1737_isa_driver);
  2098. }
  2099. i2c_del_driver(&dme1737_i2c_driver);
  2100. }
  2101. MODULE_AUTHOR("Juerg Haefliger <juergh@gmail.com>");
  2102. MODULE_DESCRIPTION("DME1737 sensors");
  2103. MODULE_LICENSE("GPL");
  2104. module_init(dme1737_init);
  2105. module_exit(dme1737_exit);