olpc_battery.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693
  1. /*
  2. * Battery driver for One Laptop Per Child board.
  3. *
  4. * Copyright © 2006-2010 David Woodhouse <dwmw2@infradead.org>
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. */
  10. #include <linux/kernel.h>
  11. #include <linux/module.h>
  12. #include <linux/types.h>
  13. #include <linux/err.h>
  14. #include <linux/device.h>
  15. #include <linux/platform_device.h>
  16. #include <linux/power_supply.h>
  17. #include <linux/jiffies.h>
  18. #include <linux/sched.h>
  19. #include <asm/olpc.h>
  20. #define EC_BAT_VOLTAGE 0x10 /* uint16_t, *9.76/32, mV */
  21. #define EC_BAT_CURRENT 0x11 /* int16_t, *15.625/120, mA */
  22. #define EC_BAT_ACR 0x12 /* int16_t, *6250/15, µAh */
  23. #define EC_BAT_TEMP 0x13 /* uint16_t, *100/256, °C */
  24. #define EC_AMB_TEMP 0x14 /* uint16_t, *100/256, °C */
  25. #define EC_BAT_STATUS 0x15 /* uint8_t, bitmask */
  26. #define EC_BAT_SOC 0x16 /* uint8_t, percentage */
  27. #define EC_BAT_SERIAL 0x17 /* uint8_t[6] */
  28. #define EC_BAT_EEPROM 0x18 /* uint8_t adr as input, uint8_t output */
  29. #define EC_BAT_ERRCODE 0x1f /* uint8_t, bitmask */
  30. #define BAT_STAT_PRESENT 0x01
  31. #define BAT_STAT_FULL 0x02
  32. #define BAT_STAT_LOW 0x04
  33. #define BAT_STAT_DESTROY 0x08
  34. #define BAT_STAT_AC 0x10
  35. #define BAT_STAT_CHARGING 0x20
  36. #define BAT_STAT_DISCHARGING 0x40
  37. #define BAT_STAT_TRICKLE 0x80
  38. #define BAT_ERR_INFOFAIL 0x02
  39. #define BAT_ERR_OVERVOLTAGE 0x04
  40. #define BAT_ERR_OVERTEMP 0x05
  41. #define BAT_ERR_GAUGESTOP 0x06
  42. #define BAT_ERR_OUT_OF_CONTROL 0x07
  43. #define BAT_ERR_ID_FAIL 0x09
  44. #define BAT_ERR_ACR_FAIL 0x10
  45. #define BAT_ADDR_MFR_TYPE 0x5F
  46. /*********************************************************************
  47. * Power
  48. *********************************************************************/
  49. static int olpc_ac_get_prop(struct power_supply *psy,
  50. enum power_supply_property psp,
  51. union power_supply_propval *val)
  52. {
  53. int ret = 0;
  54. uint8_t status;
  55. switch (psp) {
  56. case POWER_SUPPLY_PROP_ONLINE:
  57. ret = olpc_ec_cmd(EC_BAT_STATUS, NULL, 0, &status, 1);
  58. if (ret)
  59. return ret;
  60. val->intval = !!(status & BAT_STAT_AC);
  61. break;
  62. default:
  63. ret = -EINVAL;
  64. break;
  65. }
  66. return ret;
  67. }
  68. static enum power_supply_property olpc_ac_props[] = {
  69. POWER_SUPPLY_PROP_ONLINE,
  70. };
  71. static struct power_supply olpc_ac = {
  72. .name = "olpc-ac",
  73. .type = POWER_SUPPLY_TYPE_MAINS,
  74. .properties = olpc_ac_props,
  75. .num_properties = ARRAY_SIZE(olpc_ac_props),
  76. .get_property = olpc_ac_get_prop,
  77. };
  78. static char bat_serial[17]; /* Ick */
  79. static int olpc_bat_get_status(union power_supply_propval *val, uint8_t ec_byte)
  80. {
  81. if (olpc_platform_info.ecver > 0x44) {
  82. if (ec_byte & (BAT_STAT_CHARGING | BAT_STAT_TRICKLE))
  83. val->intval = POWER_SUPPLY_STATUS_CHARGING;
  84. else if (ec_byte & BAT_STAT_DISCHARGING)
  85. val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
  86. else if (ec_byte & BAT_STAT_FULL)
  87. val->intval = POWER_SUPPLY_STATUS_FULL;
  88. else /* er,... */
  89. val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
  90. } else {
  91. /* Older EC didn't report charge/discharge bits */
  92. if (!(ec_byte & BAT_STAT_AC)) /* No AC means discharging */
  93. val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
  94. else if (ec_byte & BAT_STAT_FULL)
  95. val->intval = POWER_SUPPLY_STATUS_FULL;
  96. else /* Not _necessarily_ true but EC doesn't tell all yet */
  97. val->intval = POWER_SUPPLY_STATUS_CHARGING;
  98. }
  99. return 0;
  100. }
  101. static int olpc_bat_get_health(union power_supply_propval *val)
  102. {
  103. uint8_t ec_byte;
  104. int ret;
  105. ret = olpc_ec_cmd(EC_BAT_ERRCODE, NULL, 0, &ec_byte, 1);
  106. if (ret)
  107. return ret;
  108. switch (ec_byte) {
  109. case 0:
  110. val->intval = POWER_SUPPLY_HEALTH_GOOD;
  111. break;
  112. case BAT_ERR_OVERTEMP:
  113. val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
  114. break;
  115. case BAT_ERR_OVERVOLTAGE:
  116. val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
  117. break;
  118. case BAT_ERR_INFOFAIL:
  119. case BAT_ERR_OUT_OF_CONTROL:
  120. case BAT_ERR_ID_FAIL:
  121. case BAT_ERR_ACR_FAIL:
  122. val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
  123. break;
  124. default:
  125. /* Eep. We don't know this failure code */
  126. ret = -EIO;
  127. }
  128. return ret;
  129. }
  130. static int olpc_bat_get_mfr(union power_supply_propval *val)
  131. {
  132. uint8_t ec_byte;
  133. int ret;
  134. ec_byte = BAT_ADDR_MFR_TYPE;
  135. ret = olpc_ec_cmd(EC_BAT_EEPROM, &ec_byte, 1, &ec_byte, 1);
  136. if (ret)
  137. return ret;
  138. switch (ec_byte >> 4) {
  139. case 1:
  140. val->strval = "Gold Peak";
  141. break;
  142. case 2:
  143. val->strval = "BYD";
  144. break;
  145. default:
  146. val->strval = "Unknown";
  147. break;
  148. }
  149. return ret;
  150. }
  151. static int olpc_bat_get_tech(union power_supply_propval *val)
  152. {
  153. uint8_t ec_byte;
  154. int ret;
  155. ec_byte = BAT_ADDR_MFR_TYPE;
  156. ret = olpc_ec_cmd(EC_BAT_EEPROM, &ec_byte, 1, &ec_byte, 1);
  157. if (ret)
  158. return ret;
  159. switch (ec_byte & 0xf) {
  160. case 1:
  161. val->intval = POWER_SUPPLY_TECHNOLOGY_NiMH;
  162. break;
  163. case 2:
  164. val->intval = POWER_SUPPLY_TECHNOLOGY_LiFe;
  165. break;
  166. default:
  167. val->intval = POWER_SUPPLY_TECHNOLOGY_UNKNOWN;
  168. break;
  169. }
  170. return ret;
  171. }
  172. static int olpc_bat_get_charge_full_design(union power_supply_propval *val)
  173. {
  174. uint8_t ec_byte;
  175. union power_supply_propval tech;
  176. int ret, mfr;
  177. ret = olpc_bat_get_tech(&tech);
  178. if (ret)
  179. return ret;
  180. ec_byte = BAT_ADDR_MFR_TYPE;
  181. ret = olpc_ec_cmd(EC_BAT_EEPROM, &ec_byte, 1, &ec_byte, 1);
  182. if (ret)
  183. return ret;
  184. mfr = ec_byte >> 4;
  185. switch (tech.intval) {
  186. case POWER_SUPPLY_TECHNOLOGY_NiMH:
  187. switch (mfr) {
  188. case 1: /* Gold Peak */
  189. val->intval = 3000000*.8;
  190. break;
  191. default:
  192. return -EIO;
  193. }
  194. break;
  195. case POWER_SUPPLY_TECHNOLOGY_LiFe:
  196. switch (mfr) {
  197. case 1: /* Gold Peak */
  198. val->intval = 2800000;
  199. break;
  200. case 2: /* BYD */
  201. val->intval = 3100000;
  202. break;
  203. default:
  204. return -EIO;
  205. }
  206. break;
  207. default:
  208. return -EIO;
  209. }
  210. return ret;
  211. }
  212. static int olpc_bat_get_charge_now(union power_supply_propval *val)
  213. {
  214. uint8_t soc;
  215. union power_supply_propval full;
  216. int ret;
  217. ret = olpc_ec_cmd(EC_BAT_SOC, NULL, 0, &soc, 1);
  218. if (ret)
  219. return ret;
  220. ret = olpc_bat_get_charge_full_design(&full);
  221. if (ret)
  222. return ret;
  223. val->intval = soc * (full.intval / 100);
  224. return 0;
  225. }
  226. static int olpc_bat_get_voltage_max_design(union power_supply_propval *val)
  227. {
  228. uint8_t ec_byte;
  229. union power_supply_propval tech;
  230. int mfr;
  231. int ret;
  232. ret = olpc_bat_get_tech(&tech);
  233. if (ret)
  234. return ret;
  235. ec_byte = BAT_ADDR_MFR_TYPE;
  236. ret = olpc_ec_cmd(EC_BAT_EEPROM, &ec_byte, 1, &ec_byte, 1);
  237. if (ret)
  238. return ret;
  239. mfr = ec_byte >> 4;
  240. switch (tech.intval) {
  241. case POWER_SUPPLY_TECHNOLOGY_NiMH:
  242. switch (mfr) {
  243. case 1: /* Gold Peak */
  244. val->intval = 6000000;
  245. break;
  246. default:
  247. return -EIO;
  248. }
  249. break;
  250. case POWER_SUPPLY_TECHNOLOGY_LiFe:
  251. switch (mfr) {
  252. case 1: /* Gold Peak */
  253. val->intval = 6400000;
  254. break;
  255. case 2: /* BYD */
  256. val->intval = 6500000;
  257. break;
  258. default:
  259. return -EIO;
  260. }
  261. break;
  262. default:
  263. return -EIO;
  264. }
  265. return ret;
  266. }
  267. /*********************************************************************
  268. * Battery properties
  269. *********************************************************************/
  270. static int olpc_bat_get_property(struct power_supply *psy,
  271. enum power_supply_property psp,
  272. union power_supply_propval *val)
  273. {
  274. int ret = 0;
  275. __be16 ec_word;
  276. uint8_t ec_byte;
  277. __be64 ser_buf;
  278. ret = olpc_ec_cmd(EC_BAT_STATUS, NULL, 0, &ec_byte, 1);
  279. if (ret)
  280. return ret;
  281. /* Theoretically there's a race here -- the battery could be
  282. removed immediately after we check whether it's present, and
  283. then we query for some other property of the now-absent battery.
  284. It doesn't matter though -- the EC will return the last-known
  285. information, and it's as if we just ran that _little_ bit faster
  286. and managed to read it out before the battery went away. */
  287. if (!(ec_byte & (BAT_STAT_PRESENT | BAT_STAT_TRICKLE)) &&
  288. psp != POWER_SUPPLY_PROP_PRESENT)
  289. return -ENODEV;
  290. switch (psp) {
  291. case POWER_SUPPLY_PROP_STATUS:
  292. ret = olpc_bat_get_status(val, ec_byte);
  293. if (ret)
  294. return ret;
  295. break;
  296. case POWER_SUPPLY_PROP_CHARGE_TYPE:
  297. if (ec_byte & BAT_STAT_TRICKLE)
  298. val->intval = POWER_SUPPLY_CHARGE_TYPE_TRICKLE;
  299. else if (ec_byte & BAT_STAT_CHARGING)
  300. val->intval = POWER_SUPPLY_CHARGE_TYPE_FAST;
  301. else
  302. val->intval = POWER_SUPPLY_CHARGE_TYPE_NONE;
  303. break;
  304. case POWER_SUPPLY_PROP_PRESENT:
  305. val->intval = !!(ec_byte & (BAT_STAT_PRESENT |
  306. BAT_STAT_TRICKLE));
  307. break;
  308. case POWER_SUPPLY_PROP_HEALTH:
  309. if (ec_byte & BAT_STAT_DESTROY)
  310. val->intval = POWER_SUPPLY_HEALTH_DEAD;
  311. else {
  312. ret = olpc_bat_get_health(val);
  313. if (ret)
  314. return ret;
  315. }
  316. break;
  317. case POWER_SUPPLY_PROP_MANUFACTURER:
  318. ret = olpc_bat_get_mfr(val);
  319. if (ret)
  320. return ret;
  321. break;
  322. case POWER_SUPPLY_PROP_TECHNOLOGY:
  323. ret = olpc_bat_get_tech(val);
  324. if (ret)
  325. return ret;
  326. break;
  327. case POWER_SUPPLY_PROP_VOLTAGE_AVG:
  328. case POWER_SUPPLY_PROP_VOLTAGE_NOW:
  329. ret = olpc_ec_cmd(EC_BAT_VOLTAGE, NULL, 0, (void *)&ec_word, 2);
  330. if (ret)
  331. return ret;
  332. val->intval = (s16)be16_to_cpu(ec_word) * 9760L / 32;
  333. break;
  334. case POWER_SUPPLY_PROP_CURRENT_AVG:
  335. case POWER_SUPPLY_PROP_CURRENT_NOW:
  336. ret = olpc_ec_cmd(EC_BAT_CURRENT, NULL, 0, (void *)&ec_word, 2);
  337. if (ret)
  338. return ret;
  339. val->intval = (s16)be16_to_cpu(ec_word) * 15625L / 120;
  340. break;
  341. case POWER_SUPPLY_PROP_CAPACITY:
  342. ret = olpc_ec_cmd(EC_BAT_SOC, NULL, 0, &ec_byte, 1);
  343. if (ret)
  344. return ret;
  345. val->intval = ec_byte;
  346. break;
  347. case POWER_SUPPLY_PROP_CAPACITY_LEVEL:
  348. if (ec_byte & BAT_STAT_FULL)
  349. val->intval = POWER_SUPPLY_CAPACITY_LEVEL_FULL;
  350. else if (ec_byte & BAT_STAT_LOW)
  351. val->intval = POWER_SUPPLY_CAPACITY_LEVEL_LOW;
  352. else
  353. val->intval = POWER_SUPPLY_CAPACITY_LEVEL_NORMAL;
  354. break;
  355. case POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN:
  356. ret = olpc_bat_get_charge_full_design(val);
  357. if (ret)
  358. return ret;
  359. break;
  360. case POWER_SUPPLY_PROP_CHARGE_NOW:
  361. ret = olpc_bat_get_charge_now(val);
  362. if (ret)
  363. return ret;
  364. break;
  365. case POWER_SUPPLY_PROP_TEMP:
  366. ret = olpc_ec_cmd(EC_BAT_TEMP, NULL, 0, (void *)&ec_word, 2);
  367. if (ret)
  368. return ret;
  369. val->intval = (s16)be16_to_cpu(ec_word) * 100 / 256;
  370. break;
  371. case POWER_SUPPLY_PROP_TEMP_AMBIENT:
  372. ret = olpc_ec_cmd(EC_AMB_TEMP, NULL, 0, (void *)&ec_word, 2);
  373. if (ret)
  374. return ret;
  375. val->intval = (int)be16_to_cpu(ec_word) * 100 / 256;
  376. break;
  377. case POWER_SUPPLY_PROP_CHARGE_COUNTER:
  378. ret = olpc_ec_cmd(EC_BAT_ACR, NULL, 0, (void *)&ec_word, 2);
  379. if (ret)
  380. return ret;
  381. val->intval = (s16)be16_to_cpu(ec_word) * 6250 / 15;
  382. break;
  383. case POWER_SUPPLY_PROP_SERIAL_NUMBER:
  384. ret = olpc_ec_cmd(EC_BAT_SERIAL, NULL, 0, (void *)&ser_buf, 8);
  385. if (ret)
  386. return ret;
  387. sprintf(bat_serial, "%016llx", (long long)be64_to_cpu(ser_buf));
  388. val->strval = bat_serial;
  389. break;
  390. case POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN:
  391. ret = olpc_bat_get_voltage_max_design(val);
  392. if (ret)
  393. return ret;
  394. break;
  395. default:
  396. ret = -EINVAL;
  397. break;
  398. }
  399. return ret;
  400. }
  401. static enum power_supply_property olpc_xo1_bat_props[] = {
  402. POWER_SUPPLY_PROP_STATUS,
  403. POWER_SUPPLY_PROP_CHARGE_TYPE,
  404. POWER_SUPPLY_PROP_PRESENT,
  405. POWER_SUPPLY_PROP_HEALTH,
  406. POWER_SUPPLY_PROP_TECHNOLOGY,
  407. POWER_SUPPLY_PROP_VOLTAGE_AVG,
  408. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  409. POWER_SUPPLY_PROP_CURRENT_AVG,
  410. POWER_SUPPLY_PROP_CURRENT_NOW,
  411. POWER_SUPPLY_PROP_CAPACITY,
  412. POWER_SUPPLY_PROP_CAPACITY_LEVEL,
  413. POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
  414. POWER_SUPPLY_PROP_CHARGE_NOW,
  415. POWER_SUPPLY_PROP_TEMP,
  416. POWER_SUPPLY_PROP_TEMP_AMBIENT,
  417. POWER_SUPPLY_PROP_MANUFACTURER,
  418. POWER_SUPPLY_PROP_SERIAL_NUMBER,
  419. POWER_SUPPLY_PROP_CHARGE_COUNTER,
  420. POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
  421. };
  422. /* XO-1.5 does not have ambient temperature property */
  423. static enum power_supply_property olpc_xo15_bat_props[] = {
  424. POWER_SUPPLY_PROP_STATUS,
  425. POWER_SUPPLY_PROP_CHARGE_TYPE,
  426. POWER_SUPPLY_PROP_PRESENT,
  427. POWER_SUPPLY_PROP_HEALTH,
  428. POWER_SUPPLY_PROP_TECHNOLOGY,
  429. POWER_SUPPLY_PROP_VOLTAGE_AVG,
  430. POWER_SUPPLY_PROP_VOLTAGE_NOW,
  431. POWER_SUPPLY_PROP_CURRENT_AVG,
  432. POWER_SUPPLY_PROP_CURRENT_NOW,
  433. POWER_SUPPLY_PROP_CAPACITY,
  434. POWER_SUPPLY_PROP_CAPACITY_LEVEL,
  435. POWER_SUPPLY_PROP_CHARGE_FULL_DESIGN,
  436. POWER_SUPPLY_PROP_CHARGE_NOW,
  437. POWER_SUPPLY_PROP_TEMP,
  438. POWER_SUPPLY_PROP_MANUFACTURER,
  439. POWER_SUPPLY_PROP_SERIAL_NUMBER,
  440. POWER_SUPPLY_PROP_CHARGE_COUNTER,
  441. POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN,
  442. };
  443. /* EEPROM reading goes completely around the power_supply API, sadly */
  444. #define EEPROM_START 0x20
  445. #define EEPROM_END 0x80
  446. #define EEPROM_SIZE (EEPROM_END - EEPROM_START)
  447. static ssize_t olpc_bat_eeprom_read(struct file *filp, struct kobject *kobj,
  448. struct bin_attribute *attr, char *buf, loff_t off, size_t count)
  449. {
  450. uint8_t ec_byte;
  451. int ret;
  452. int i;
  453. if (off >= EEPROM_SIZE)
  454. return 0;
  455. if (off + count > EEPROM_SIZE)
  456. count = EEPROM_SIZE - off;
  457. for (i = 0; i < count; i++) {
  458. ec_byte = EEPROM_START + off + i;
  459. ret = olpc_ec_cmd(EC_BAT_EEPROM, &ec_byte, 1, &buf[i], 1);
  460. if (ret) {
  461. pr_err("olpc-battery: "
  462. "EC_BAT_EEPROM cmd @ 0x%x failed - %d!\n",
  463. ec_byte, ret);
  464. return -EIO;
  465. }
  466. }
  467. return count;
  468. }
  469. static struct bin_attribute olpc_bat_eeprom = {
  470. .attr = {
  471. .name = "eeprom",
  472. .mode = S_IRUGO,
  473. },
  474. .size = 0,
  475. .read = olpc_bat_eeprom_read,
  476. };
  477. /* Allow userspace to see the specific error value pulled from the EC */
  478. static ssize_t olpc_bat_error_read(struct device *dev,
  479. struct device_attribute *attr, char *buf)
  480. {
  481. uint8_t ec_byte;
  482. ssize_t ret;
  483. ret = olpc_ec_cmd(EC_BAT_ERRCODE, NULL, 0, &ec_byte, 1);
  484. if (ret < 0)
  485. return ret;
  486. return sprintf(buf, "%d\n", ec_byte);
  487. }
  488. static struct device_attribute olpc_bat_error = {
  489. .attr = {
  490. .name = "error",
  491. .mode = S_IRUGO,
  492. },
  493. .show = olpc_bat_error_read,
  494. };
  495. /*********************************************************************
  496. * Initialisation
  497. *********************************************************************/
  498. static struct power_supply olpc_bat = {
  499. .name = "olpc-battery",
  500. .get_property = olpc_bat_get_property,
  501. .use_for_apm = 1,
  502. };
  503. static int olpc_battery_suspend(struct platform_device *pdev,
  504. pm_message_t state)
  505. {
  506. if (device_may_wakeup(olpc_ac.dev))
  507. olpc_ec_wakeup_set(EC_SCI_SRC_ACPWR);
  508. else
  509. olpc_ec_wakeup_clear(EC_SCI_SRC_ACPWR);
  510. if (device_may_wakeup(olpc_bat.dev))
  511. olpc_ec_wakeup_set(EC_SCI_SRC_BATTERY | EC_SCI_SRC_BATSOC
  512. | EC_SCI_SRC_BATERR);
  513. else
  514. olpc_ec_wakeup_clear(EC_SCI_SRC_BATTERY | EC_SCI_SRC_BATSOC
  515. | EC_SCI_SRC_BATERR);
  516. return 0;
  517. }
  518. static int __devinit olpc_battery_probe(struct platform_device *pdev)
  519. {
  520. int ret;
  521. uint8_t status;
  522. /*
  523. * We've seen a number of EC protocol changes; this driver requires
  524. * the latest EC protocol, supported by 0x44 and above.
  525. */
  526. if (olpc_platform_info.ecver < 0x44) {
  527. printk(KERN_NOTICE "OLPC EC version 0x%02x too old for "
  528. "battery driver.\n", olpc_platform_info.ecver);
  529. return -ENXIO;
  530. }
  531. ret = olpc_ec_cmd(EC_BAT_STATUS, NULL, 0, &status, 1);
  532. if (ret)
  533. return ret;
  534. /* Ignore the status. It doesn't actually matter */
  535. ret = power_supply_register(&pdev->dev, &olpc_ac);
  536. if (ret)
  537. return ret;
  538. if (olpc_board_at_least(olpc_board_pre(0xd0))) { /* XO-1.5 */
  539. olpc_bat.properties = olpc_xo15_bat_props;
  540. olpc_bat.num_properties = ARRAY_SIZE(olpc_xo15_bat_props);
  541. } else { /* XO-1 */
  542. olpc_bat.properties = olpc_xo1_bat_props;
  543. olpc_bat.num_properties = ARRAY_SIZE(olpc_xo1_bat_props);
  544. }
  545. ret = power_supply_register(&pdev->dev, &olpc_bat);
  546. if (ret)
  547. goto battery_failed;
  548. ret = device_create_bin_file(olpc_bat.dev, &olpc_bat_eeprom);
  549. if (ret)
  550. goto eeprom_failed;
  551. ret = device_create_file(olpc_bat.dev, &olpc_bat_error);
  552. if (ret)
  553. goto error_failed;
  554. if (olpc_ec_wakeup_available()) {
  555. device_set_wakeup_capable(olpc_ac.dev, true);
  556. device_set_wakeup_capable(olpc_bat.dev, true);
  557. }
  558. return 0;
  559. error_failed:
  560. device_remove_bin_file(olpc_bat.dev, &olpc_bat_eeprom);
  561. eeprom_failed:
  562. power_supply_unregister(&olpc_bat);
  563. battery_failed:
  564. power_supply_unregister(&olpc_ac);
  565. return ret;
  566. }
  567. static int __devexit olpc_battery_remove(struct platform_device *pdev)
  568. {
  569. device_remove_file(olpc_bat.dev, &olpc_bat_error);
  570. device_remove_bin_file(olpc_bat.dev, &olpc_bat_eeprom);
  571. power_supply_unregister(&olpc_bat);
  572. power_supply_unregister(&olpc_ac);
  573. return 0;
  574. }
  575. static const struct of_device_id olpc_battery_ids[] __devinitconst = {
  576. { .compatible = "olpc,xo1-battery" },
  577. {}
  578. };
  579. MODULE_DEVICE_TABLE(of, olpc_battery_ids);
  580. static struct platform_driver olpc_battery_driver = {
  581. .driver = {
  582. .name = "olpc-battery",
  583. .owner = THIS_MODULE,
  584. .of_match_table = olpc_battery_ids,
  585. },
  586. .probe = olpc_battery_probe,
  587. .remove = __devexit_p(olpc_battery_remove),
  588. .suspend = olpc_battery_suspend,
  589. };
  590. module_platform_driver(olpc_battery_driver);
  591. MODULE_AUTHOR("David Woodhouse <dwmw2@infradead.org>");
  592. MODULE_LICENSE("GPL");
  593. MODULE_DESCRIPTION("Battery driver for One Laptop Per Child 'XO' machine");