dme1737.c 68 KB

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