max6639.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652
  1. /*
  2. * max6639.c - Support for Maxim MAX6639
  3. *
  4. * 2-Channel Temperature Monitor with Dual PWM Fan-Speed Controller
  5. *
  6. * Copyright (C) 2010, 2011 Roland Stigge <stigge@antcom.de>
  7. *
  8. * based on the initial MAX6639 support from semptian.net
  9. * by He Changqing <hechangqing@semptian.com>
  10. *
  11. * This program is free software; you can redistribute it and/or modify
  12. * it under the terms of the GNU General Public License as published by
  13. * the Free Software Foundation; either version 2 of the License, or
  14. * (at your option) any later version.
  15. *
  16. * This program is distributed in the hope that it will be useful,
  17. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  18. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  19. * GNU General Public License for more details.
  20. *
  21. * You should have received a copy of the GNU General Public License
  22. * along with this program; if not, write to the Free Software
  23. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  24. */
  25. #include <linux/module.h>
  26. #include <linux/init.h>
  27. #include <linux/slab.h>
  28. #include <linux/jiffies.h>
  29. #include <linux/i2c.h>
  30. #include <linux/hwmon.h>
  31. #include <linux/hwmon-sysfs.h>
  32. #include <linux/err.h>
  33. #include <linux/mutex.h>
  34. #include <linux/i2c/max6639.h>
  35. /* Addresses to scan */
  36. static unsigned short normal_i2c[] = { 0x2c, 0x2e, 0x2f, I2C_CLIENT_END };
  37. /* The MAX6639 registers, valid channel numbers: 0, 1 */
  38. #define MAX6639_REG_TEMP(ch) (0x00 + (ch))
  39. #define MAX6639_REG_STATUS 0x02
  40. #define MAX6639_REG_OUTPUT_MASK 0x03
  41. #define MAX6639_REG_GCONFIG 0x04
  42. #define MAX6639_REG_TEMP_EXT(ch) (0x05 + (ch))
  43. #define MAX6639_REG_ALERT_LIMIT(ch) (0x08 + (ch))
  44. #define MAX6639_REG_OT_LIMIT(ch) (0x0A + (ch))
  45. #define MAX6639_REG_THERM_LIMIT(ch) (0x0C + (ch))
  46. #define MAX6639_REG_FAN_CONFIG1(ch) (0x10 + (ch) * 4)
  47. #define MAX6639_REG_FAN_CONFIG2a(ch) (0x11 + (ch) * 4)
  48. #define MAX6639_REG_FAN_CONFIG2b(ch) (0x12 + (ch) * 4)
  49. #define MAX6639_REG_FAN_CONFIG3(ch) (0x13 + (ch) * 4)
  50. #define MAX6639_REG_FAN_CNT(ch) (0x20 + (ch))
  51. #define MAX6639_REG_TARGET_CNT(ch) (0x22 + (ch))
  52. #define MAX6639_REG_FAN_PPR(ch) (0x24 + (ch))
  53. #define MAX6639_REG_TARGTDUTY(ch) (0x26 + (ch))
  54. #define MAX6639_REG_FAN_START_TEMP(ch) (0x28 + (ch))
  55. #define MAX6639_REG_DEVID 0x3D
  56. #define MAX6639_REG_MANUID 0x3E
  57. #define MAX6639_REG_DEVREV 0x3F
  58. /* Register bits */
  59. #define MAX6639_GCONFIG_STANDBY 0x80
  60. #define MAX6639_GCONFIG_POR 0x40
  61. #define MAX6639_GCONFIG_DISABLE_TIMEOUT 0x20
  62. #define MAX6639_GCONFIG_CH2_LOCAL 0x10
  63. #define MAX6639_GCONFIG_PWM_FREQ_HI 0x08
  64. #define MAX6639_FAN_CONFIG1_PWM 0x80
  65. #define MAX6639_FAN_CONFIG3_THERM_FULL_SPEED 0x40
  66. static const int rpm_ranges[] = { 2000, 4000, 8000, 16000 };
  67. #define FAN_FROM_REG(val, rpm_range) ((val) == 0 || (val) == 255 ? \
  68. 0 : (rpm_ranges[rpm_range] * 30) / (val))
  69. #define TEMP_LIMIT_TO_REG(val) SENSORS_LIMIT((val) / 1000, 0, 255)
  70. /*
  71. * Client data (each client gets its own)
  72. */
  73. struct max6639_data {
  74. struct device *hwmon_dev;
  75. struct mutex update_lock;
  76. char valid; /* !=0 if following fields are valid */
  77. unsigned long last_updated; /* In jiffies */
  78. /* Register values sampled regularly */
  79. u16 temp[2]; /* Temperature, in 1/8 C, 0..255 C */
  80. bool temp_fault[2]; /* Detected temperature diode failure */
  81. u8 fan[2]; /* Register value: TACH count for fans >=30 */
  82. u8 status; /* Detected channel alarms and fan failures */
  83. /* Register values only written to */
  84. u8 pwm[2]; /* Register value: Duty cycle 0..120 */
  85. u8 temp_therm[2]; /* THERM Temperature, 0..255 C (->_max) */
  86. u8 temp_alert[2]; /* ALERT Temperature, 0..255 C (->_crit) */
  87. u8 temp_ot[2]; /* OT Temperature, 0..255 C (->_emergency) */
  88. /* Register values initialized only once */
  89. u8 ppr; /* Pulses per rotation 0..3 for 1..4 ppr */
  90. u8 rpm_range; /* Index in above rpm_ranges table */
  91. };
  92. static struct max6639_data *max6639_update_device(struct device *dev)
  93. {
  94. struct i2c_client *client = to_i2c_client(dev);
  95. struct max6639_data *data = i2c_get_clientdata(client);
  96. struct max6639_data *ret = data;
  97. int i;
  98. int status_reg;
  99. mutex_lock(&data->update_lock);
  100. if (time_after(jiffies, data->last_updated + 2 * HZ) || !data->valid) {
  101. int res;
  102. dev_dbg(&client->dev, "Starting max6639 update\n");
  103. status_reg = i2c_smbus_read_byte_data(client,
  104. MAX6639_REG_STATUS);
  105. if (status_reg < 0) {
  106. ret = ERR_PTR(status_reg);
  107. goto abort;
  108. }
  109. data->status = status_reg;
  110. for (i = 0; i < 2; i++) {
  111. res = i2c_smbus_read_byte_data(client,
  112. MAX6639_REG_FAN_CNT(i));
  113. if (res < 0) {
  114. ret = ERR_PTR(res);
  115. goto abort;
  116. }
  117. data->fan[i] = res;
  118. res = i2c_smbus_read_byte_data(client,
  119. MAX6639_REG_TEMP_EXT(i));
  120. if (res < 0) {
  121. ret = ERR_PTR(res);
  122. goto abort;
  123. }
  124. data->temp[i] = res >> 5;
  125. data->temp_fault[i] = res & 0x01;
  126. res = i2c_smbus_read_byte_data(client,
  127. MAX6639_REG_TEMP(i));
  128. if (res < 0) {
  129. ret = ERR_PTR(res);
  130. goto abort;
  131. }
  132. data->temp[i] |= res << 3;
  133. }
  134. data->last_updated = jiffies;
  135. data->valid = 1;
  136. }
  137. abort:
  138. mutex_unlock(&data->update_lock);
  139. return ret;
  140. }
  141. static ssize_t show_temp_input(struct device *dev,
  142. struct device_attribute *dev_attr, char *buf)
  143. {
  144. long temp;
  145. struct max6639_data *data = max6639_update_device(dev);
  146. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  147. if (IS_ERR(data))
  148. return PTR_ERR(data);
  149. temp = data->temp[attr->index] * 125;
  150. return sprintf(buf, "%ld\n", temp);
  151. }
  152. static ssize_t show_temp_fault(struct device *dev,
  153. struct device_attribute *dev_attr, char *buf)
  154. {
  155. struct max6639_data *data = max6639_update_device(dev);
  156. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  157. if (IS_ERR(data))
  158. return PTR_ERR(data);
  159. return sprintf(buf, "%d\n", data->temp_fault[attr->index]);
  160. }
  161. static ssize_t show_temp_max(struct device *dev,
  162. struct device_attribute *dev_attr, char *buf)
  163. {
  164. struct i2c_client *client = to_i2c_client(dev);
  165. struct max6639_data *data = i2c_get_clientdata(client);
  166. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  167. return sprintf(buf, "%d\n", (data->temp_therm[attr->index] * 1000));
  168. }
  169. static ssize_t set_temp_max(struct device *dev,
  170. struct device_attribute *dev_attr,
  171. const char *buf, size_t count)
  172. {
  173. struct i2c_client *client = to_i2c_client(dev);
  174. struct max6639_data *data = i2c_get_clientdata(client);
  175. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  176. unsigned long val;
  177. int res;
  178. res = kstrtoul(buf, 10, &val);
  179. if (res)
  180. return res;
  181. mutex_lock(&data->update_lock);
  182. data->temp_therm[attr->index] = TEMP_LIMIT_TO_REG(val);
  183. i2c_smbus_write_byte_data(client,
  184. MAX6639_REG_THERM_LIMIT(attr->index),
  185. data->temp_therm[attr->index]);
  186. mutex_unlock(&data->update_lock);
  187. return count;
  188. }
  189. static ssize_t show_temp_crit(struct device *dev,
  190. struct device_attribute *dev_attr, char *buf)
  191. {
  192. struct i2c_client *client = to_i2c_client(dev);
  193. struct max6639_data *data = i2c_get_clientdata(client);
  194. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  195. return sprintf(buf, "%d\n", (data->temp_alert[attr->index] * 1000));
  196. }
  197. static ssize_t set_temp_crit(struct device *dev,
  198. struct device_attribute *dev_attr,
  199. const char *buf, size_t count)
  200. {
  201. struct i2c_client *client = to_i2c_client(dev);
  202. struct max6639_data *data = i2c_get_clientdata(client);
  203. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  204. unsigned long val;
  205. int res;
  206. res = kstrtoul(buf, 10, &val);
  207. if (res)
  208. return res;
  209. mutex_lock(&data->update_lock);
  210. data->temp_alert[attr->index] = TEMP_LIMIT_TO_REG(val);
  211. i2c_smbus_write_byte_data(client,
  212. MAX6639_REG_ALERT_LIMIT(attr->index),
  213. data->temp_alert[attr->index]);
  214. mutex_unlock(&data->update_lock);
  215. return count;
  216. }
  217. static ssize_t show_temp_emergency(struct device *dev,
  218. struct device_attribute *dev_attr,
  219. char *buf)
  220. {
  221. struct i2c_client *client = to_i2c_client(dev);
  222. struct max6639_data *data = i2c_get_clientdata(client);
  223. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  224. return sprintf(buf, "%d\n", (data->temp_ot[attr->index] * 1000));
  225. }
  226. static ssize_t set_temp_emergency(struct device *dev,
  227. struct device_attribute *dev_attr,
  228. const char *buf, size_t count)
  229. {
  230. struct i2c_client *client = to_i2c_client(dev);
  231. struct max6639_data *data = i2c_get_clientdata(client);
  232. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  233. unsigned long val;
  234. int res;
  235. res = kstrtoul(buf, 10, &val);
  236. if (res)
  237. return res;
  238. mutex_lock(&data->update_lock);
  239. data->temp_ot[attr->index] = TEMP_LIMIT_TO_REG(val);
  240. i2c_smbus_write_byte_data(client,
  241. MAX6639_REG_OT_LIMIT(attr->index),
  242. data->temp_ot[attr->index]);
  243. mutex_unlock(&data->update_lock);
  244. return count;
  245. }
  246. static ssize_t show_pwm(struct device *dev,
  247. struct device_attribute *dev_attr, char *buf)
  248. {
  249. struct i2c_client *client = to_i2c_client(dev);
  250. struct max6639_data *data = i2c_get_clientdata(client);
  251. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  252. return sprintf(buf, "%d\n", data->pwm[attr->index] * 255 / 120);
  253. }
  254. static ssize_t set_pwm(struct device *dev,
  255. struct device_attribute *dev_attr,
  256. const char *buf, size_t count)
  257. {
  258. struct i2c_client *client = to_i2c_client(dev);
  259. struct max6639_data *data = i2c_get_clientdata(client);
  260. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  261. unsigned long val;
  262. int res;
  263. res = kstrtoul(buf, 10, &val);
  264. if (res)
  265. return res;
  266. val = SENSORS_LIMIT(val, 0, 255);
  267. mutex_lock(&data->update_lock);
  268. data->pwm[attr->index] = (u8)(val * 120 / 255);
  269. i2c_smbus_write_byte_data(client,
  270. MAX6639_REG_TARGTDUTY(attr->index),
  271. data->pwm[attr->index]);
  272. mutex_unlock(&data->update_lock);
  273. return count;
  274. }
  275. static ssize_t show_fan_input(struct device *dev,
  276. struct device_attribute *dev_attr, char *buf)
  277. {
  278. struct max6639_data *data = max6639_update_device(dev);
  279. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  280. if (IS_ERR(data))
  281. return PTR_ERR(data);
  282. return sprintf(buf, "%d\n", FAN_FROM_REG(data->fan[attr->index],
  283. data->rpm_range));
  284. }
  285. static ssize_t show_alarm(struct device *dev,
  286. struct device_attribute *dev_attr, char *buf)
  287. {
  288. struct max6639_data *data = max6639_update_device(dev);
  289. struct sensor_device_attribute *attr = to_sensor_dev_attr(dev_attr);
  290. if (IS_ERR(data))
  291. return PTR_ERR(data);
  292. return sprintf(buf, "%d\n", !!(data->status & (1 << attr->index)));
  293. }
  294. static SENSOR_DEVICE_ATTR(temp1_input, S_IRUGO, show_temp_input, NULL, 0);
  295. static SENSOR_DEVICE_ATTR(temp2_input, S_IRUGO, show_temp_input, NULL, 1);
  296. static SENSOR_DEVICE_ATTR(temp1_fault, S_IRUGO, show_temp_fault, NULL, 0);
  297. static SENSOR_DEVICE_ATTR(temp2_fault, S_IRUGO, show_temp_fault, NULL, 1);
  298. static SENSOR_DEVICE_ATTR(temp1_max, S_IWUSR | S_IRUGO, show_temp_max,
  299. set_temp_max, 0);
  300. static SENSOR_DEVICE_ATTR(temp2_max, S_IWUSR | S_IRUGO, show_temp_max,
  301. set_temp_max, 1);
  302. static SENSOR_DEVICE_ATTR(temp1_crit, S_IWUSR | S_IRUGO, show_temp_crit,
  303. set_temp_crit, 0);
  304. static SENSOR_DEVICE_ATTR(temp2_crit, S_IWUSR | S_IRUGO, show_temp_crit,
  305. set_temp_crit, 1);
  306. static SENSOR_DEVICE_ATTR(temp1_emergency, S_IWUSR | S_IRUGO,
  307. show_temp_emergency, set_temp_emergency, 0);
  308. static SENSOR_DEVICE_ATTR(temp2_emergency, S_IWUSR | S_IRUGO,
  309. show_temp_emergency, set_temp_emergency, 1);
  310. static SENSOR_DEVICE_ATTR(pwm1, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 0);
  311. static SENSOR_DEVICE_ATTR(pwm2, S_IWUSR | S_IRUGO, show_pwm, set_pwm, 1);
  312. static SENSOR_DEVICE_ATTR(fan1_input, S_IRUGO, show_fan_input, NULL, 0);
  313. static SENSOR_DEVICE_ATTR(fan2_input, S_IRUGO, show_fan_input, NULL, 1);
  314. static SENSOR_DEVICE_ATTR(fan1_fault, S_IRUGO, show_alarm, NULL, 1);
  315. static SENSOR_DEVICE_ATTR(fan2_fault, S_IRUGO, show_alarm, NULL, 0);
  316. static SENSOR_DEVICE_ATTR(temp1_max_alarm, S_IRUGO, show_alarm, NULL, 3);
  317. static SENSOR_DEVICE_ATTR(temp2_max_alarm, S_IRUGO, show_alarm, NULL, 2);
  318. static SENSOR_DEVICE_ATTR(temp1_crit_alarm, S_IRUGO, show_alarm, NULL, 7);
  319. static SENSOR_DEVICE_ATTR(temp2_crit_alarm, S_IRUGO, show_alarm, NULL, 6);
  320. static SENSOR_DEVICE_ATTR(temp1_emergency_alarm, S_IRUGO, show_alarm, NULL, 5);
  321. static SENSOR_DEVICE_ATTR(temp2_emergency_alarm, S_IRUGO, show_alarm, NULL, 4);
  322. static struct attribute *max6639_attributes[] = {
  323. &sensor_dev_attr_temp1_input.dev_attr.attr,
  324. &sensor_dev_attr_temp2_input.dev_attr.attr,
  325. &sensor_dev_attr_temp1_fault.dev_attr.attr,
  326. &sensor_dev_attr_temp2_fault.dev_attr.attr,
  327. &sensor_dev_attr_temp1_max.dev_attr.attr,
  328. &sensor_dev_attr_temp2_max.dev_attr.attr,
  329. &sensor_dev_attr_temp1_crit.dev_attr.attr,
  330. &sensor_dev_attr_temp2_crit.dev_attr.attr,
  331. &sensor_dev_attr_temp1_emergency.dev_attr.attr,
  332. &sensor_dev_attr_temp2_emergency.dev_attr.attr,
  333. &sensor_dev_attr_pwm1.dev_attr.attr,
  334. &sensor_dev_attr_pwm2.dev_attr.attr,
  335. &sensor_dev_attr_fan1_input.dev_attr.attr,
  336. &sensor_dev_attr_fan2_input.dev_attr.attr,
  337. &sensor_dev_attr_fan1_fault.dev_attr.attr,
  338. &sensor_dev_attr_fan2_fault.dev_attr.attr,
  339. &sensor_dev_attr_temp1_max_alarm.dev_attr.attr,
  340. &sensor_dev_attr_temp2_max_alarm.dev_attr.attr,
  341. &sensor_dev_attr_temp1_crit_alarm.dev_attr.attr,
  342. &sensor_dev_attr_temp2_crit_alarm.dev_attr.attr,
  343. &sensor_dev_attr_temp1_emergency_alarm.dev_attr.attr,
  344. &sensor_dev_attr_temp2_emergency_alarm.dev_attr.attr,
  345. NULL
  346. };
  347. static const struct attribute_group max6639_group = {
  348. .attrs = max6639_attributes,
  349. };
  350. /*
  351. * returns respective index in rpm_ranges table
  352. * 1 by default on invalid range
  353. */
  354. static int rpm_range_to_reg(int range)
  355. {
  356. int i;
  357. for (i = 0; i < ARRAY_SIZE(rpm_ranges); i++) {
  358. if (rpm_ranges[i] == range)
  359. return i;
  360. }
  361. return 1; /* default: 4000 RPM */
  362. }
  363. static int max6639_init_client(struct i2c_client *client)
  364. {
  365. struct max6639_data *data = i2c_get_clientdata(client);
  366. struct max6639_platform_data *max6639_info =
  367. client->dev.platform_data;
  368. int i;
  369. int rpm_range = 1; /* default: 4000 RPM */
  370. int err;
  371. /* Reset chip to default values, see below for GCONFIG setup */
  372. err = i2c_smbus_write_byte_data(client, MAX6639_REG_GCONFIG,
  373. MAX6639_GCONFIG_POR);
  374. if (err)
  375. goto exit;
  376. /* Fans pulse per revolution is 2 by default */
  377. if (max6639_info && max6639_info->ppr > 0 &&
  378. max6639_info->ppr < 5)
  379. data->ppr = max6639_info->ppr;
  380. else
  381. data->ppr = 2;
  382. data->ppr -= 1;
  383. if (max6639_info)
  384. rpm_range = rpm_range_to_reg(max6639_info->rpm_range);
  385. data->rpm_range = rpm_range;
  386. for (i = 0; i < 2; i++) {
  387. /* Set Fan pulse per revolution */
  388. err = i2c_smbus_write_byte_data(client,
  389. MAX6639_REG_FAN_PPR(i),
  390. data->ppr << 6);
  391. if (err)
  392. goto exit;
  393. /* Fans config PWM, RPM */
  394. err = i2c_smbus_write_byte_data(client,
  395. MAX6639_REG_FAN_CONFIG1(i),
  396. MAX6639_FAN_CONFIG1_PWM | rpm_range);
  397. if (err)
  398. goto exit;
  399. /* Fans PWM polarity high by default */
  400. if (max6639_info && max6639_info->pwm_polarity == 0)
  401. err = i2c_smbus_write_byte_data(client,
  402. MAX6639_REG_FAN_CONFIG2a(i), 0x00);
  403. else
  404. err = i2c_smbus_write_byte_data(client,
  405. MAX6639_REG_FAN_CONFIG2a(i), 0x02);
  406. if (err)
  407. goto exit;
  408. /*
  409. * /THERM full speed enable,
  410. * PWM frequency 25kHz, see also GCONFIG below
  411. */
  412. err = i2c_smbus_write_byte_data(client,
  413. MAX6639_REG_FAN_CONFIG3(i),
  414. MAX6639_FAN_CONFIG3_THERM_FULL_SPEED | 0x03);
  415. if (err)
  416. goto exit;
  417. /* Max. temp. 80C/90C/100C */
  418. data->temp_therm[i] = 80;
  419. data->temp_alert[i] = 90;
  420. data->temp_ot[i] = 100;
  421. err = i2c_smbus_write_byte_data(client,
  422. MAX6639_REG_THERM_LIMIT(i),
  423. data->temp_therm[i]);
  424. if (err)
  425. goto exit;
  426. err = i2c_smbus_write_byte_data(client,
  427. MAX6639_REG_ALERT_LIMIT(i),
  428. data->temp_alert[i]);
  429. if (err)
  430. goto exit;
  431. err = i2c_smbus_write_byte_data(client,
  432. MAX6639_REG_OT_LIMIT(i), data->temp_ot[i]);
  433. if (err)
  434. goto exit;
  435. /* PWM 120/120 (i.e. 100%) */
  436. data->pwm[i] = 120;
  437. err = i2c_smbus_write_byte_data(client,
  438. MAX6639_REG_TARGTDUTY(i), data->pwm[i]);
  439. if (err)
  440. goto exit;
  441. }
  442. /* Start monitoring */
  443. err = i2c_smbus_write_byte_data(client, MAX6639_REG_GCONFIG,
  444. MAX6639_GCONFIG_DISABLE_TIMEOUT | MAX6639_GCONFIG_CH2_LOCAL |
  445. MAX6639_GCONFIG_PWM_FREQ_HI);
  446. exit:
  447. return err;
  448. }
  449. /* Return 0 if detection is successful, -ENODEV otherwise */
  450. static int max6639_detect(struct i2c_client *client,
  451. struct i2c_board_info *info)
  452. {
  453. struct i2c_adapter *adapter = client->adapter;
  454. int dev_id, manu_id;
  455. if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
  456. return -ENODEV;
  457. /* Actual detection via device and manufacturer ID */
  458. dev_id = i2c_smbus_read_byte_data(client, MAX6639_REG_DEVID);
  459. manu_id = i2c_smbus_read_byte_data(client, MAX6639_REG_MANUID);
  460. if (dev_id != 0x58 || manu_id != 0x4D)
  461. return -ENODEV;
  462. strlcpy(info->type, "max6639", I2C_NAME_SIZE);
  463. return 0;
  464. }
  465. static int max6639_probe(struct i2c_client *client,
  466. const struct i2c_device_id *id)
  467. {
  468. struct max6639_data *data;
  469. int err;
  470. data = kzalloc(sizeof(struct max6639_data), GFP_KERNEL);
  471. if (!data) {
  472. err = -ENOMEM;
  473. goto exit;
  474. }
  475. i2c_set_clientdata(client, data);
  476. mutex_init(&data->update_lock);
  477. /* Initialize the max6639 chip */
  478. err = max6639_init_client(client);
  479. if (err < 0)
  480. goto error_free;
  481. /* Register sysfs hooks */
  482. err = sysfs_create_group(&client->dev.kobj, &max6639_group);
  483. if (err)
  484. goto error_free;
  485. data->hwmon_dev = hwmon_device_register(&client->dev);
  486. if (IS_ERR(data->hwmon_dev)) {
  487. err = PTR_ERR(data->hwmon_dev);
  488. goto error_remove;
  489. }
  490. dev_info(&client->dev, "temperature sensor and fan control found\n");
  491. return 0;
  492. error_remove:
  493. sysfs_remove_group(&client->dev.kobj, &max6639_group);
  494. error_free:
  495. kfree(data);
  496. exit:
  497. return err;
  498. }
  499. static int max6639_remove(struct i2c_client *client)
  500. {
  501. struct max6639_data *data = i2c_get_clientdata(client);
  502. hwmon_device_unregister(data->hwmon_dev);
  503. sysfs_remove_group(&client->dev.kobj, &max6639_group);
  504. kfree(data);
  505. return 0;
  506. }
  507. #ifdef CONFIG_PM_SLEEP
  508. static int max6639_suspend(struct device *dev)
  509. {
  510. struct i2c_client *client = to_i2c_client(dev);
  511. int data = i2c_smbus_read_byte_data(client, MAX6639_REG_GCONFIG);
  512. if (data < 0)
  513. return data;
  514. return i2c_smbus_write_byte_data(client,
  515. MAX6639_REG_GCONFIG, data | MAX6639_GCONFIG_STANDBY);
  516. }
  517. static int max6639_resume(struct device *dev)
  518. {
  519. struct i2c_client *client = to_i2c_client(dev);
  520. int data = i2c_smbus_read_byte_data(client, MAX6639_REG_GCONFIG);
  521. if (data < 0)
  522. return data;
  523. return i2c_smbus_write_byte_data(client,
  524. MAX6639_REG_GCONFIG, data & ~MAX6639_GCONFIG_STANDBY);
  525. }
  526. #endif /* CONFIG_PM_SLEEP */
  527. static const struct i2c_device_id max6639_id[] = {
  528. {"max6639", 0},
  529. { }
  530. };
  531. MODULE_DEVICE_TABLE(i2c, max6639_id);
  532. static const struct dev_pm_ops max6639_pm_ops = {
  533. SET_SYSTEM_SLEEP_PM_OPS(max6639_suspend, max6639_resume)
  534. };
  535. static struct i2c_driver max6639_driver = {
  536. .class = I2C_CLASS_HWMON,
  537. .driver = {
  538. .name = "max6639",
  539. .pm = &max6639_pm_ops,
  540. },
  541. .probe = max6639_probe,
  542. .remove = max6639_remove,
  543. .id_table = max6639_id,
  544. .detect = max6639_detect,
  545. .address_list = normal_i2c,
  546. };
  547. module_i2c_driver(max6639_driver);
  548. MODULE_AUTHOR("Roland Stigge <stigge@antcom.de>");
  549. MODULE_DESCRIPTION("max6639 driver");
  550. MODULE_LICENSE("GPL");