dme1737.c 77 KB

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