g762.c 28 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * g762 - Driver for the Global Mixed-mode Technology Inc. fan speed
  4. * PWM controller chips from G762 family, i.e. G762 and G763
  5. *
  6. * Copyright (C) 2013, Arnaud EBALARD <arno@natisbad.org>
  7. *
  8. * This work is based on a basic version for 2.6.31 kernel developed
  9. * by Olivier Mouchet for LaCie. Updates and correction have been
  10. * performed to run on recent kernels. Additional features, like the
  11. * ability to configure various characteristics via .dts file or
  12. * board init file have been added. Detailed datasheet on which this
  13. * development is based is available here:
  14. *
  15. * http://natisbad.org/NAS/refs/GMT_EDS-762_763-080710-0.2.pdf
  16. *
  17. * Headers from previous developments have been kept below:
  18. *
  19. * Copyright (c) 2009 LaCie
  20. *
  21. * Author: Olivier Mouchet <olivier.mouchet@gmail.com>
  22. *
  23. * based on g760a code written by Herbert Valerio Riedel <hvr@gnu.org>
  24. * Copyright (C) 2007 Herbert Valerio Riedel <hvr@gnu.org>
  25. *
  26. * g762: minimal datasheet available at:
  27. * http://www.gmt.com.tw/product/datasheet/EDS-762_3.pdf
  28. */
  29. #include <linux/device.h>
  30. #include <linux/module.h>
  31. #include <linux/init.h>
  32. #include <linux/jiffies.h>
  33. #include <linux/i2c.h>
  34. #include <linux/hwmon.h>
  35. #include <linux/hwmon-sysfs.h>
  36. #include <linux/err.h>
  37. #include <linux/mutex.h>
  38. #include <linux/kernel.h>
  39. #include <linux/clk.h>
  40. #include <linux/of.h>
  41. #include <linux/platform_data/g762.h>
  42. #define DRVNAME "g762"
  43. static const struct i2c_device_id g762_id[] = {
  44. { "g761" },
  45. { "g762" },
  46. { "g763" },
  47. { }
  48. };
  49. MODULE_DEVICE_TABLE(i2c, g762_id);
  50. enum g762_regs {
  51. G762_REG_SET_CNT = 0x00,
  52. G762_REG_ACT_CNT = 0x01,
  53. G762_REG_FAN_STA = 0x02,
  54. G762_REG_SET_OUT = 0x03,
  55. G762_REG_FAN_CMD1 = 0x04,
  56. G762_REG_FAN_CMD2 = 0x05,
  57. };
  58. /* Config register bits */
  59. #define G762_REG_FAN_CMD1_DET_FAN_FAIL 0x80 /* enable fan_fail signal */
  60. #define G762_REG_FAN_CMD1_DET_FAN_OOC 0x40 /* enable fan_out_of_control */
  61. #define G762_REG_FAN_CMD1_OUT_MODE 0x20 /* out mode: PWM or DC */
  62. #define G762_REG_FAN_CMD1_FAN_MODE 0x10 /* fan mode: closed/open-loop */
  63. #define G762_REG_FAN_CMD1_CLK_DIV_ID1 0x08 /* clock divisor value */
  64. #define G762_REG_FAN_CMD1_CLK_DIV_ID0 0x04
  65. #define G762_REG_FAN_CMD1_PWM_POLARITY 0x02 /* PWM polarity */
  66. #define G762_REG_FAN_CMD1_PULSE_PER_REV 0x01 /* pulse per fan revolution */
  67. #define G761_REG_FAN_CMD2_FAN_CLOCK 0x20 /* choose internal clock*/
  68. #define G762_REG_FAN_CMD2_GEAR_MODE_1 0x08 /* fan gear mode */
  69. #define G762_REG_FAN_CMD2_GEAR_MODE_0 0x04
  70. #define G762_REG_FAN_CMD2_FAN_STARTV_1 0x02 /* fan startup voltage */
  71. #define G762_REG_FAN_CMD2_FAN_STARTV_0 0x01
  72. #define G762_REG_FAN_STA_FAIL 0x02 /* fan fail */
  73. #define G762_REG_FAN_STA_OOC 0x01 /* fan out of control */
  74. /* Config register values */
  75. #define G762_OUT_MODE_PWM 1
  76. #define G762_OUT_MODE_DC 0
  77. #define G762_FAN_MODE_CLOSED_LOOP 2
  78. #define G762_FAN_MODE_OPEN_LOOP 1
  79. #define G762_PWM_POLARITY_NEGATIVE 1
  80. #define G762_PWM_POLARITY_POSITIVE 0
  81. /* Register data is read (and cached) at most once per second. */
  82. #define G762_UPDATE_INTERVAL HZ
  83. /*
  84. * Extract pulse count per fan revolution value (2 or 4) from given
  85. * FAN_CMD1 register value.
  86. */
  87. #define G762_PULSE_FROM_REG(reg) \
  88. ((((reg) & G762_REG_FAN_CMD1_PULSE_PER_REV) + 1) << 1)
  89. /*
  90. * Extract fan clock divisor (1, 2, 4 or 8) from given FAN_CMD1
  91. * register value.
  92. */
  93. #define G762_CLKDIV_FROM_REG(reg) \
  94. (1 << (((reg) & (G762_REG_FAN_CMD1_CLK_DIV_ID0 | \
  95. G762_REG_FAN_CMD1_CLK_DIV_ID1)) >> 2))
  96. /*
  97. * Extract fan gear mode multiplier value (0, 2 or 4) from given
  98. * FAN_CMD2 register value.
  99. */
  100. #define G762_GEARMULT_FROM_REG(reg) \
  101. (1 << (((reg) & (G762_REG_FAN_CMD2_GEAR_MODE_0 | \
  102. G762_REG_FAN_CMD2_GEAR_MODE_1)) >> 2))
  103. struct g762_data {
  104. struct i2c_client *client;
  105. bool internal_clock;
  106. struct clk *clk;
  107. /* update mutex */
  108. struct mutex update_lock;
  109. /* board specific parameters. */
  110. u32 clk_freq;
  111. /* g762 register cache */
  112. bool valid;
  113. unsigned long last_updated; /* in jiffies */
  114. u8 set_cnt; /* controls fan rotation speed in closed-loop mode */
  115. u8 act_cnt; /* provides access to current fan RPM value */
  116. u8 fan_sta; /* bit 0: set when actual fan speed is more than
  117. * 25% outside requested fan speed
  118. * bit 1: set when no transition occurs on fan
  119. * pin for 0.7s
  120. */
  121. u8 set_out; /* controls fan rotation speed in open-loop mode */
  122. u8 fan_cmd1; /* 0: FG_PLS_ID0 FG pulses count per revolution
  123. * 0: 2 counts per revolution
  124. * 1: 4 counts per revolution
  125. * 1: PWM_POLARITY 1: negative_duty
  126. * 0: positive_duty
  127. * 2,3: [FG_CLOCK_ID0, FG_CLK_ID1]
  128. * 00: Divide fan clock by 1
  129. * 01: Divide fan clock by 2
  130. * 10: Divide fan clock by 4
  131. * 11: Divide fan clock by 8
  132. * 4: FAN_MODE 1:closed-loop, 0:open-loop
  133. * 5: OUT_MODE 1:PWM, 0:DC
  134. * 6: DET_FAN_OOC enable "fan ooc" status
  135. * 7: DET_FAN_FAIL enable "fan fail" status
  136. */
  137. u8 fan_cmd2; /* 0,1: FAN_STARTV 0,1,2,3 -> 0,32,64,96 dac_code
  138. * 2,3: FG_GEAR_MODE
  139. * 00: multiplier = 1
  140. * 01: multiplier = 2
  141. * 10: multiplier = 4
  142. * 4: Mask ALERT# (g763 only)
  143. */
  144. };
  145. /*
  146. * Convert count value from fan controller register (FAN_SET_CNT) into fan
  147. * speed RPM value. Note that the datasheet documents a basic formula;
  148. * influence of additional parameters (fan clock divisor, fan gear mode)
  149. * have been infered from examples in the datasheet and tests.
  150. */
  151. static inline unsigned int rpm_from_cnt(u8 cnt, u32 clk_freq, u16 p,
  152. u8 clk_div, u8 gear_mult)
  153. {
  154. if (cnt == 0xff) /* setting cnt to 255 stops the fan */
  155. return 0;
  156. return (clk_freq * 30 * gear_mult) / ((cnt ? cnt : 1) * p * clk_div);
  157. }
  158. /*
  159. * Convert fan RPM value from sysfs into count value for fan controller
  160. * register (FAN_SET_CNT).
  161. */
  162. static inline unsigned char cnt_from_rpm(unsigned long rpm, u32 clk_freq, u16 p,
  163. u8 clk_div, u8 gear_mult)
  164. {
  165. unsigned long f1 = clk_freq * 30 * gear_mult;
  166. unsigned long f2 = p * clk_div;
  167. if (!rpm) /* to stop the fan, set cnt to 255 */
  168. return 0xff;
  169. rpm = clamp_val(rpm, f1 / (255 * f2), ULONG_MAX / f2);
  170. return DIV_ROUND_CLOSEST(f1, rpm * f2);
  171. }
  172. /* helper to grab and cache data, at most one time per second */
  173. static struct g762_data *g762_update_client(struct device *dev)
  174. {
  175. struct g762_data *data = dev_get_drvdata(dev);
  176. struct i2c_client *client = data->client;
  177. int ret = 0;
  178. mutex_lock(&data->update_lock);
  179. if (time_before(jiffies, data->last_updated + G762_UPDATE_INTERVAL) &&
  180. likely(data->valid))
  181. goto out;
  182. ret = i2c_smbus_read_byte_data(client, G762_REG_SET_CNT);
  183. if (ret < 0)
  184. goto out;
  185. data->set_cnt = ret;
  186. ret = i2c_smbus_read_byte_data(client, G762_REG_ACT_CNT);
  187. if (ret < 0)
  188. goto out;
  189. data->act_cnt = ret;
  190. ret = i2c_smbus_read_byte_data(client, G762_REG_FAN_STA);
  191. if (ret < 0)
  192. goto out;
  193. data->fan_sta = ret;
  194. ret = i2c_smbus_read_byte_data(client, G762_REG_SET_OUT);
  195. if (ret < 0)
  196. goto out;
  197. data->set_out = ret;
  198. ret = i2c_smbus_read_byte_data(client, G762_REG_FAN_CMD1);
  199. if (ret < 0)
  200. goto out;
  201. data->fan_cmd1 = ret;
  202. ret = i2c_smbus_read_byte_data(client, G762_REG_FAN_CMD2);
  203. if (ret < 0)
  204. goto out;
  205. data->fan_cmd2 = ret;
  206. data->last_updated = jiffies;
  207. data->valid = true;
  208. out:
  209. mutex_unlock(&data->update_lock);
  210. if (ret < 0) /* upon error, encode it in return value */
  211. data = ERR_PTR(ret);
  212. return data;
  213. }
  214. /* helpers for writing hardware parameters */
  215. /*
  216. * Set input clock frequency received on CLK pin of the chip. Accepted values
  217. * are between 0 and 0xffffff. If zero is given, then default frequency
  218. * (32,768Hz) is used. Note that clock frequency is a characteristic of the
  219. * system but an internal parameter, i.e. value is not passed to the device.
  220. */
  221. static int do_set_clk_freq(struct device *dev, unsigned long val)
  222. {
  223. struct g762_data *data = dev_get_drvdata(dev);
  224. if (val > 0xffffff)
  225. return -EINVAL;
  226. if (!val)
  227. val = 32768;
  228. data->clk_freq = val;
  229. return 0;
  230. }
  231. /* Set pwm mode. Accepts either 0 (PWM mode) or 1 (DC mode) */
  232. static int do_set_pwm_mode(struct device *dev, unsigned long val)
  233. {
  234. struct g762_data *data = g762_update_client(dev);
  235. int ret;
  236. if (IS_ERR(data))
  237. return PTR_ERR(data);
  238. mutex_lock(&data->update_lock);
  239. switch (val) {
  240. case G762_OUT_MODE_PWM:
  241. data->fan_cmd1 |= G762_REG_FAN_CMD1_OUT_MODE;
  242. break;
  243. case G762_OUT_MODE_DC:
  244. data->fan_cmd1 &= ~G762_REG_FAN_CMD1_OUT_MODE;
  245. break;
  246. default:
  247. ret = -EINVAL;
  248. goto out;
  249. }
  250. ret = i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD1,
  251. data->fan_cmd1);
  252. data->valid = false;
  253. out:
  254. mutex_unlock(&data->update_lock);
  255. return ret;
  256. }
  257. /* Set fan clock divisor. Accepts either 1, 2, 4 or 8. */
  258. static int do_set_fan_div(struct device *dev, unsigned long val)
  259. {
  260. struct g762_data *data = g762_update_client(dev);
  261. int ret;
  262. if (IS_ERR(data))
  263. return PTR_ERR(data);
  264. mutex_lock(&data->update_lock);
  265. switch (val) {
  266. case 1:
  267. data->fan_cmd1 &= ~G762_REG_FAN_CMD1_CLK_DIV_ID0;
  268. data->fan_cmd1 &= ~G762_REG_FAN_CMD1_CLK_DIV_ID1;
  269. break;
  270. case 2:
  271. data->fan_cmd1 |= G762_REG_FAN_CMD1_CLK_DIV_ID0;
  272. data->fan_cmd1 &= ~G762_REG_FAN_CMD1_CLK_DIV_ID1;
  273. break;
  274. case 4:
  275. data->fan_cmd1 &= ~G762_REG_FAN_CMD1_CLK_DIV_ID0;
  276. data->fan_cmd1 |= G762_REG_FAN_CMD1_CLK_DIV_ID1;
  277. break;
  278. case 8:
  279. data->fan_cmd1 |= G762_REG_FAN_CMD1_CLK_DIV_ID0;
  280. data->fan_cmd1 |= G762_REG_FAN_CMD1_CLK_DIV_ID1;
  281. break;
  282. default:
  283. ret = -EINVAL;
  284. goto out;
  285. }
  286. ret = i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD1,
  287. data->fan_cmd1);
  288. data->valid = false;
  289. out:
  290. mutex_unlock(&data->update_lock);
  291. return ret;
  292. }
  293. /* Set fan gear mode. Accepts either 0, 1 or 2. */
  294. static int do_set_fan_gear_mode(struct device *dev, unsigned long val)
  295. {
  296. struct g762_data *data = g762_update_client(dev);
  297. int ret;
  298. if (IS_ERR(data))
  299. return PTR_ERR(data);
  300. mutex_lock(&data->update_lock);
  301. switch (val) {
  302. case 0:
  303. data->fan_cmd2 &= ~G762_REG_FAN_CMD2_GEAR_MODE_0;
  304. data->fan_cmd2 &= ~G762_REG_FAN_CMD2_GEAR_MODE_1;
  305. break;
  306. case 1:
  307. data->fan_cmd2 |= G762_REG_FAN_CMD2_GEAR_MODE_0;
  308. data->fan_cmd2 &= ~G762_REG_FAN_CMD2_GEAR_MODE_1;
  309. break;
  310. case 2:
  311. data->fan_cmd2 &= ~G762_REG_FAN_CMD2_GEAR_MODE_0;
  312. data->fan_cmd2 |= G762_REG_FAN_CMD2_GEAR_MODE_1;
  313. break;
  314. default:
  315. ret = -EINVAL;
  316. goto out;
  317. }
  318. ret = i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD2,
  319. data->fan_cmd2);
  320. data->valid = false;
  321. out:
  322. mutex_unlock(&data->update_lock);
  323. return ret;
  324. }
  325. /* Set number of fan pulses per revolution. Accepts either 2 or 4. */
  326. static int do_set_fan_pulses(struct device *dev, unsigned long val)
  327. {
  328. struct g762_data *data = g762_update_client(dev);
  329. int ret;
  330. if (IS_ERR(data))
  331. return PTR_ERR(data);
  332. mutex_lock(&data->update_lock);
  333. switch (val) {
  334. case 2:
  335. data->fan_cmd1 &= ~G762_REG_FAN_CMD1_PULSE_PER_REV;
  336. break;
  337. case 4:
  338. data->fan_cmd1 |= G762_REG_FAN_CMD1_PULSE_PER_REV;
  339. break;
  340. default:
  341. ret = -EINVAL;
  342. goto out;
  343. }
  344. ret = i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD1,
  345. data->fan_cmd1);
  346. data->valid = false;
  347. out:
  348. mutex_unlock(&data->update_lock);
  349. return ret;
  350. }
  351. /* Set fan mode. Accepts either 1 (open-loop) or 2 (closed-loop). */
  352. static int do_set_pwm_enable(struct device *dev, unsigned long val)
  353. {
  354. struct g762_data *data = g762_update_client(dev);
  355. int ret;
  356. if (IS_ERR(data))
  357. return PTR_ERR(data);
  358. mutex_lock(&data->update_lock);
  359. switch (val) {
  360. case G762_FAN_MODE_CLOSED_LOOP:
  361. data->fan_cmd1 |= G762_REG_FAN_CMD1_FAN_MODE;
  362. break;
  363. case G762_FAN_MODE_OPEN_LOOP:
  364. data->fan_cmd1 &= ~G762_REG_FAN_CMD1_FAN_MODE;
  365. /*
  366. * BUG FIX: if SET_CNT register value is 255 then, for some
  367. * unknown reason, fan will not rotate as expected, no matter
  368. * the value of SET_OUT (to be specific, this seems to happen
  369. * only in PWM mode). To workaround this bug, we give SET_CNT
  370. * value of 254 if it is 255 when switching to open-loop.
  371. */
  372. if (data->set_cnt == 0xff)
  373. i2c_smbus_write_byte_data(data->client,
  374. G762_REG_SET_CNT, 254);
  375. break;
  376. default:
  377. ret = -EINVAL;
  378. goto out;
  379. }
  380. ret = i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD1,
  381. data->fan_cmd1);
  382. data->valid = false;
  383. out:
  384. mutex_unlock(&data->update_lock);
  385. return ret;
  386. }
  387. /* Set PWM polarity. Accepts either 0 (positive duty) or 1 (negative duty) */
  388. static int do_set_pwm_polarity(struct device *dev, unsigned long val)
  389. {
  390. struct g762_data *data = g762_update_client(dev);
  391. int ret;
  392. if (IS_ERR(data))
  393. return PTR_ERR(data);
  394. mutex_lock(&data->update_lock);
  395. switch (val) {
  396. case G762_PWM_POLARITY_POSITIVE:
  397. data->fan_cmd1 &= ~G762_REG_FAN_CMD1_PWM_POLARITY;
  398. break;
  399. case G762_PWM_POLARITY_NEGATIVE:
  400. data->fan_cmd1 |= G762_REG_FAN_CMD1_PWM_POLARITY;
  401. break;
  402. default:
  403. ret = -EINVAL;
  404. goto out;
  405. }
  406. ret = i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD1,
  407. data->fan_cmd1);
  408. data->valid = false;
  409. out:
  410. mutex_unlock(&data->update_lock);
  411. return ret;
  412. }
  413. /*
  414. * Set pwm value. Accepts values between 0 (stops the fan) and
  415. * 255 (full speed). This only makes sense in open-loop mode.
  416. */
  417. static int do_set_pwm(struct device *dev, unsigned long val)
  418. {
  419. struct g762_data *data = dev_get_drvdata(dev);
  420. struct i2c_client *client = data->client;
  421. int ret;
  422. if (val > 255)
  423. return -EINVAL;
  424. mutex_lock(&data->update_lock);
  425. ret = i2c_smbus_write_byte_data(client, G762_REG_SET_OUT, val);
  426. data->valid = false;
  427. mutex_unlock(&data->update_lock);
  428. return ret;
  429. }
  430. /*
  431. * Set fan RPM value. Can be called both in closed and open-loop mode
  432. * but effect will only be seen after closed-loop mode is configured.
  433. */
  434. static int do_set_fan_target(struct device *dev, unsigned long val)
  435. {
  436. struct g762_data *data = g762_update_client(dev);
  437. int ret;
  438. if (IS_ERR(data))
  439. return PTR_ERR(data);
  440. mutex_lock(&data->update_lock);
  441. data->set_cnt = cnt_from_rpm(val, data->clk_freq,
  442. G762_PULSE_FROM_REG(data->fan_cmd1),
  443. G762_CLKDIV_FROM_REG(data->fan_cmd1),
  444. G762_GEARMULT_FROM_REG(data->fan_cmd2));
  445. ret = i2c_smbus_write_byte_data(data->client, G762_REG_SET_CNT,
  446. data->set_cnt);
  447. data->valid = false;
  448. mutex_unlock(&data->update_lock);
  449. return ret;
  450. }
  451. /* Set fan startup voltage. Accepted values are either 0, 1, 2 or 3. */
  452. static int do_set_fan_startv(struct device *dev, unsigned long val)
  453. {
  454. struct g762_data *data = g762_update_client(dev);
  455. int ret;
  456. if (IS_ERR(data))
  457. return PTR_ERR(data);
  458. mutex_lock(&data->update_lock);
  459. switch (val) {
  460. case 0:
  461. data->fan_cmd2 &= ~G762_REG_FAN_CMD2_FAN_STARTV_0;
  462. data->fan_cmd2 &= ~G762_REG_FAN_CMD2_FAN_STARTV_1;
  463. break;
  464. case 1:
  465. data->fan_cmd2 |= G762_REG_FAN_CMD2_FAN_STARTV_0;
  466. data->fan_cmd2 &= ~G762_REG_FAN_CMD2_FAN_STARTV_1;
  467. break;
  468. case 2:
  469. data->fan_cmd2 &= ~G762_REG_FAN_CMD2_FAN_STARTV_0;
  470. data->fan_cmd2 |= G762_REG_FAN_CMD2_FAN_STARTV_1;
  471. break;
  472. case 3:
  473. data->fan_cmd2 |= G762_REG_FAN_CMD2_FAN_STARTV_0;
  474. data->fan_cmd2 |= G762_REG_FAN_CMD2_FAN_STARTV_1;
  475. break;
  476. default:
  477. ret = -EINVAL;
  478. goto out;
  479. }
  480. ret = i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD2,
  481. data->fan_cmd2);
  482. data->valid = false;
  483. out:
  484. mutex_unlock(&data->update_lock);
  485. return ret;
  486. }
  487. /*
  488. * Helper to import hardware characteristics from .dts file and push
  489. * those to the chip.
  490. */
  491. #ifdef CONFIG_OF
  492. static const struct of_device_id g762_dt_match[] = {
  493. { .compatible = "gmt,g761" },
  494. { .compatible = "gmt,g762" },
  495. { .compatible = "gmt,g763" },
  496. { },
  497. };
  498. MODULE_DEVICE_TABLE(of, g762_dt_match);
  499. /*
  500. * Grab clock (a required property), enable it, get (fixed) clock frequency
  501. * and store it. Note: upon success, clock has been prepared and enabled; it
  502. * must later be unprepared and disabled (e.g. during module unloading) by a
  503. * call to g762_of_clock_disable(). Note that a reference to clock is kept
  504. * in our private data structure to be used in this function.
  505. */
  506. static void g762_of_clock_disable(void *data)
  507. {
  508. struct g762_data *g762 = data;
  509. clk_disable_unprepare(g762->clk);
  510. clk_put(g762->clk);
  511. }
  512. static int g762_of_clock_enable(struct i2c_client *client)
  513. {
  514. struct g762_data *data;
  515. unsigned long clk_freq;
  516. struct clk *clk;
  517. int ret;
  518. if (!client->dev.of_node)
  519. return 0;
  520. data = i2c_get_clientdata(client);
  521. /*
  522. * Skip CLK detection and handling if we use internal clock.
  523. * This is only valid for g761.
  524. */
  525. data->internal_clock = of_device_is_compatible(client->dev.of_node,
  526. "gmt,g761") &&
  527. !of_property_present(client->dev.of_node,
  528. "clocks");
  529. if (data->internal_clock) {
  530. do_set_clk_freq(&client->dev, 32768);
  531. return 0;
  532. }
  533. clk = of_clk_get(client->dev.of_node, 0);
  534. if (IS_ERR(clk)) {
  535. dev_err(&client->dev, "failed to get clock\n");
  536. return PTR_ERR(clk);
  537. }
  538. ret = clk_prepare_enable(clk);
  539. if (ret) {
  540. dev_err(&client->dev, "failed to enable clock\n");
  541. goto clk_put;
  542. }
  543. clk_freq = clk_get_rate(clk);
  544. ret = do_set_clk_freq(&client->dev, clk_freq);
  545. if (ret) {
  546. dev_err(&client->dev, "invalid clock freq %lu\n", clk_freq);
  547. goto clk_unprep;
  548. }
  549. data->clk = clk;
  550. ret = devm_add_action(&client->dev, g762_of_clock_disable, data);
  551. if (ret) {
  552. dev_err(&client->dev, "failed to add disable clock action\n");
  553. goto clk_unprep;
  554. }
  555. return 0;
  556. clk_unprep:
  557. clk_disable_unprepare(clk);
  558. clk_put:
  559. clk_put(clk);
  560. return ret;
  561. }
  562. static int g762_of_prop_import_one(struct i2c_client *client,
  563. const char *pname,
  564. int (*psetter)(struct device *dev,
  565. unsigned long val))
  566. {
  567. int ret;
  568. u32 pval;
  569. if (of_property_read_u32(client->dev.of_node, pname, &pval))
  570. return 0;
  571. dev_dbg(&client->dev, "found %s (%d)\n", pname, pval);
  572. ret = (*psetter)(&client->dev, pval);
  573. if (ret)
  574. dev_err(&client->dev, "unable to set %s (%d)\n", pname, pval);
  575. return ret;
  576. }
  577. static int g762_of_prop_import(struct i2c_client *client)
  578. {
  579. int ret;
  580. if (!client->dev.of_node)
  581. return 0;
  582. ret = g762_of_prop_import_one(client, "fan_gear_mode",
  583. do_set_fan_gear_mode);
  584. if (ret)
  585. return ret;
  586. ret = g762_of_prop_import_one(client, "pwm_polarity",
  587. do_set_pwm_polarity);
  588. if (ret)
  589. return ret;
  590. return g762_of_prop_import_one(client, "fan_startv",
  591. do_set_fan_startv);
  592. }
  593. #else
  594. static int g762_of_prop_import(struct i2c_client *client)
  595. {
  596. return 0;
  597. }
  598. static int g762_of_clock_enable(struct i2c_client *client)
  599. {
  600. return 0;
  601. }
  602. #endif
  603. /*
  604. * Helper to import hardware characteristics from .dts file and push
  605. * those to the chip.
  606. */
  607. static int g762_pdata_prop_import(struct i2c_client *client)
  608. {
  609. struct g762_platform_data *pdata = dev_get_platdata(&client->dev);
  610. int ret;
  611. if (!pdata)
  612. return 0;
  613. ret = do_set_fan_gear_mode(&client->dev, pdata->fan_gear_mode);
  614. if (ret)
  615. return ret;
  616. ret = do_set_pwm_polarity(&client->dev, pdata->pwm_polarity);
  617. if (ret)
  618. return ret;
  619. ret = do_set_fan_startv(&client->dev, pdata->fan_startv);
  620. if (ret)
  621. return ret;
  622. return do_set_clk_freq(&client->dev, pdata->clk_freq);
  623. }
  624. /*
  625. * sysfs attributes
  626. */
  627. /*
  628. * Read function for fan1_input sysfs file. Return current fan RPM value, or
  629. * 0 if fan is out of control.
  630. */
  631. static ssize_t fan1_input_show(struct device *dev,
  632. struct device_attribute *da, char *buf)
  633. {
  634. struct g762_data *data = g762_update_client(dev);
  635. unsigned int rpm = 0;
  636. if (IS_ERR(data))
  637. return PTR_ERR(data);
  638. mutex_lock(&data->update_lock);
  639. /* reverse logic: fan out of control reporting is enabled low */
  640. if (data->fan_sta & G762_REG_FAN_STA_OOC) {
  641. rpm = rpm_from_cnt(data->act_cnt, data->clk_freq,
  642. G762_PULSE_FROM_REG(data->fan_cmd1),
  643. G762_CLKDIV_FROM_REG(data->fan_cmd1),
  644. G762_GEARMULT_FROM_REG(data->fan_cmd2));
  645. }
  646. mutex_unlock(&data->update_lock);
  647. return sprintf(buf, "%u\n", rpm);
  648. }
  649. /*
  650. * Read and write functions for pwm1_mode sysfs file. Get and set fan speed
  651. * control mode i.e. PWM (1) or DC (0).
  652. */
  653. static ssize_t pwm1_mode_show(struct device *dev, struct device_attribute *da,
  654. char *buf)
  655. {
  656. struct g762_data *data = g762_update_client(dev);
  657. if (IS_ERR(data))
  658. return PTR_ERR(data);
  659. return sprintf(buf, "%d\n",
  660. !!(data->fan_cmd1 & G762_REG_FAN_CMD1_OUT_MODE));
  661. }
  662. static ssize_t pwm1_mode_store(struct device *dev,
  663. struct device_attribute *da, const char *buf,
  664. size_t count)
  665. {
  666. unsigned long val;
  667. int ret;
  668. if (kstrtoul(buf, 10, &val))
  669. return -EINVAL;
  670. ret = do_set_pwm_mode(dev, val);
  671. if (ret < 0)
  672. return ret;
  673. return count;
  674. }
  675. /*
  676. * Read and write functions for fan1_div sysfs file. Get and set fan
  677. * controller prescaler value
  678. */
  679. static ssize_t fan1_div_show(struct device *dev, struct device_attribute *da,
  680. char *buf)
  681. {
  682. struct g762_data *data = g762_update_client(dev);
  683. if (IS_ERR(data))
  684. return PTR_ERR(data);
  685. return sprintf(buf, "%d\n", G762_CLKDIV_FROM_REG(data->fan_cmd1));
  686. }
  687. static ssize_t fan1_div_store(struct device *dev, struct device_attribute *da,
  688. const char *buf, size_t count)
  689. {
  690. unsigned long val;
  691. int ret;
  692. if (kstrtoul(buf, 10, &val))
  693. return -EINVAL;
  694. ret = do_set_fan_div(dev, val);
  695. if (ret < 0)
  696. return ret;
  697. return count;
  698. }
  699. /*
  700. * Read and write functions for fan1_pulses sysfs file. Get and set number
  701. * of tachometer pulses per fan revolution.
  702. */
  703. static ssize_t fan1_pulses_show(struct device *dev,
  704. struct device_attribute *da, char *buf)
  705. {
  706. struct g762_data *data = g762_update_client(dev);
  707. if (IS_ERR(data))
  708. return PTR_ERR(data);
  709. return sprintf(buf, "%d\n", G762_PULSE_FROM_REG(data->fan_cmd1));
  710. }
  711. static ssize_t fan1_pulses_store(struct device *dev,
  712. struct device_attribute *da, const char *buf,
  713. size_t count)
  714. {
  715. unsigned long val;
  716. int ret;
  717. if (kstrtoul(buf, 10, &val))
  718. return -EINVAL;
  719. ret = do_set_fan_pulses(dev, val);
  720. if (ret < 0)
  721. return ret;
  722. return count;
  723. }
  724. /*
  725. * Read and write functions for pwm1_enable. Get and set fan speed control mode
  726. * (i.e. closed or open-loop).
  727. *
  728. * Following documentation about hwmon's sysfs interface, a pwm1_enable node
  729. * should accept the following:
  730. *
  731. * 0 : no fan speed control (i.e. fan at full speed)
  732. * 1 : manual fan speed control enabled (use pwm[1-*]) (open-loop)
  733. * 2+: automatic fan speed control enabled (use fan[1-*]_target) (closed-loop)
  734. *
  735. * but we do not accept 0 as this mode is not natively supported by the chip
  736. * and it is not emulated by g762 driver. -EINVAL is returned in this case.
  737. */
  738. static ssize_t pwm1_enable_show(struct device *dev,
  739. struct device_attribute *da, char *buf)
  740. {
  741. struct g762_data *data = g762_update_client(dev);
  742. if (IS_ERR(data))
  743. return PTR_ERR(data);
  744. return sprintf(buf, "%d\n",
  745. (!!(data->fan_cmd1 & G762_REG_FAN_CMD1_FAN_MODE)) + 1);
  746. }
  747. static ssize_t pwm1_enable_store(struct device *dev,
  748. struct device_attribute *da, const char *buf,
  749. size_t count)
  750. {
  751. unsigned long val;
  752. int ret;
  753. if (kstrtoul(buf, 10, &val))
  754. return -EINVAL;
  755. ret = do_set_pwm_enable(dev, val);
  756. if (ret < 0)
  757. return ret;
  758. return count;
  759. }
  760. /*
  761. * Read and write functions for pwm1 sysfs file. Get and set pwm value
  762. * (which affects fan speed) in open-loop mode. 0 stops the fan and 255
  763. * makes it run at full speed.
  764. */
  765. static ssize_t pwm1_show(struct device *dev, struct device_attribute *da,
  766. char *buf)
  767. {
  768. struct g762_data *data = g762_update_client(dev);
  769. if (IS_ERR(data))
  770. return PTR_ERR(data);
  771. return sprintf(buf, "%d\n", data->set_out);
  772. }
  773. static ssize_t pwm1_store(struct device *dev, struct device_attribute *da,
  774. const char *buf, size_t count)
  775. {
  776. unsigned long val;
  777. int ret;
  778. if (kstrtoul(buf, 10, &val))
  779. return -EINVAL;
  780. ret = do_set_pwm(dev, val);
  781. if (ret < 0)
  782. return ret;
  783. return count;
  784. }
  785. /*
  786. * Read and write function for fan1_target sysfs file. Get/set the fan speed in
  787. * closed-loop mode. Speed is given as a RPM value; then the chip will regulate
  788. * the fan speed using pulses from fan tachometer.
  789. *
  790. * Refer to rpm_from_cnt() implementation above to get info about count number
  791. * calculation.
  792. *
  793. * Also note that due to rounding errors it is possible that you don't read
  794. * back exactly the value you have set.
  795. */
  796. static ssize_t fan1_target_show(struct device *dev,
  797. struct device_attribute *da, char *buf)
  798. {
  799. struct g762_data *data = g762_update_client(dev);
  800. unsigned int rpm;
  801. if (IS_ERR(data))
  802. return PTR_ERR(data);
  803. mutex_lock(&data->update_lock);
  804. rpm = rpm_from_cnt(data->set_cnt, data->clk_freq,
  805. G762_PULSE_FROM_REG(data->fan_cmd1),
  806. G762_CLKDIV_FROM_REG(data->fan_cmd1),
  807. G762_GEARMULT_FROM_REG(data->fan_cmd2));
  808. mutex_unlock(&data->update_lock);
  809. return sprintf(buf, "%u\n", rpm);
  810. }
  811. static ssize_t fan1_target_store(struct device *dev,
  812. struct device_attribute *da, const char *buf,
  813. size_t count)
  814. {
  815. unsigned long val;
  816. int ret;
  817. if (kstrtoul(buf, 10, &val))
  818. return -EINVAL;
  819. ret = do_set_fan_target(dev, val);
  820. if (ret < 0)
  821. return ret;
  822. return count;
  823. }
  824. /* read function for fan1_fault sysfs file. */
  825. static ssize_t fan1_fault_show(struct device *dev, struct device_attribute *da,
  826. char *buf)
  827. {
  828. struct g762_data *data = g762_update_client(dev);
  829. if (IS_ERR(data))
  830. return PTR_ERR(data);
  831. return sprintf(buf, "%u\n", !!(data->fan_sta & G762_REG_FAN_STA_FAIL));
  832. }
  833. /*
  834. * read function for fan1_alarm sysfs file. Note that OOC condition is
  835. * enabled low
  836. */
  837. static ssize_t fan1_alarm_show(struct device *dev,
  838. struct device_attribute *da, char *buf)
  839. {
  840. struct g762_data *data = g762_update_client(dev);
  841. if (IS_ERR(data))
  842. return PTR_ERR(data);
  843. return sprintf(buf, "%u\n", !(data->fan_sta & G762_REG_FAN_STA_OOC));
  844. }
  845. static DEVICE_ATTR_RW(pwm1);
  846. static DEVICE_ATTR_RW(pwm1_mode);
  847. static DEVICE_ATTR_RW(pwm1_enable);
  848. static DEVICE_ATTR_RO(fan1_input);
  849. static DEVICE_ATTR_RO(fan1_alarm);
  850. static DEVICE_ATTR_RO(fan1_fault);
  851. static DEVICE_ATTR_RW(fan1_target);
  852. static DEVICE_ATTR_RW(fan1_div);
  853. static DEVICE_ATTR_RW(fan1_pulses);
  854. /* Driver data */
  855. static struct attribute *g762_attrs[] = {
  856. &dev_attr_fan1_input.attr,
  857. &dev_attr_fan1_alarm.attr,
  858. &dev_attr_fan1_fault.attr,
  859. &dev_attr_fan1_target.attr,
  860. &dev_attr_fan1_div.attr,
  861. &dev_attr_fan1_pulses.attr,
  862. &dev_attr_pwm1.attr,
  863. &dev_attr_pwm1_mode.attr,
  864. &dev_attr_pwm1_enable.attr,
  865. NULL
  866. };
  867. ATTRIBUTE_GROUPS(g762);
  868. /*
  869. * Enable both fan failure detection and fan out of control protection. The
  870. * function does not protect change/access to data structure; it must thus
  871. * only be called during initialization.
  872. */
  873. static inline int g762_fan_init(struct device *dev)
  874. {
  875. struct g762_data *data = g762_update_client(dev);
  876. int ret;
  877. if (IS_ERR(data))
  878. return PTR_ERR(data);
  879. /* internal_clock can only be set with compatible g761 */
  880. if (data->internal_clock)
  881. data->fan_cmd2 |= G761_REG_FAN_CMD2_FAN_CLOCK;
  882. data->fan_cmd1 |= G762_REG_FAN_CMD1_DET_FAN_FAIL;
  883. data->fan_cmd1 |= G762_REG_FAN_CMD1_DET_FAN_OOC;
  884. data->valid = false;
  885. ret = i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD1,
  886. data->fan_cmd1);
  887. if (ret)
  888. return ret;
  889. return i2c_smbus_write_byte_data(data->client, G762_REG_FAN_CMD2,
  890. data->fan_cmd2);
  891. }
  892. static int g762_probe(struct i2c_client *client)
  893. {
  894. struct device *dev = &client->dev;
  895. struct device *hwmon_dev;
  896. struct g762_data *data;
  897. int ret;
  898. if (!i2c_check_functionality(client->adapter,
  899. I2C_FUNC_SMBUS_BYTE_DATA))
  900. return -ENODEV;
  901. data = devm_kzalloc(dev, sizeof(struct g762_data), GFP_KERNEL);
  902. if (!data)
  903. return -ENOMEM;
  904. i2c_set_clientdata(client, data);
  905. data->client = client;
  906. mutex_init(&data->update_lock);
  907. /* Get configuration via DT ... */
  908. ret = g762_of_clock_enable(client);
  909. if (ret)
  910. return ret;
  911. /* Enable fan failure detection and fan out of control protection */
  912. ret = g762_fan_init(dev);
  913. if (ret)
  914. return ret;
  915. ret = g762_of_prop_import(client);
  916. if (ret)
  917. return ret;
  918. /* ... or platform_data */
  919. ret = g762_pdata_prop_import(client);
  920. if (ret)
  921. return ret;
  922. hwmon_dev = devm_hwmon_device_register_with_groups(dev, client->name,
  923. data, g762_groups);
  924. return PTR_ERR_OR_ZERO(hwmon_dev);
  925. }
  926. static struct i2c_driver g762_driver = {
  927. .driver = {
  928. .name = DRVNAME,
  929. .of_match_table = of_match_ptr(g762_dt_match),
  930. },
  931. .probe = g762_probe,
  932. .id_table = g762_id,
  933. };
  934. module_i2c_driver(g762_driver);
  935. MODULE_AUTHOR("Arnaud EBALARD <arno@natisbad.org>");
  936. MODULE_DESCRIPTION("GMT G762/G763 driver");
  937. MODULE_LICENSE("GPL");