dme1737.c 67 KB

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