tps6586x.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682
  1. /*
  2. * Core driver for TI TPS6586x PMIC family
  3. *
  4. * Copyright (c) 2010 CompuLab Ltd.
  5. * Mike Rapoport <mike@compulab.co.il>
  6. *
  7. * Based on da903x.c.
  8. * Copyright (C) 2008 Compulab, Ltd.
  9. * Mike Rapoport <mike@compulab.co.il>
  10. * Copyright (C) 2006-2008 Marvell International Ltd.
  11. * Eric Miao <eric.miao@marvell.com>
  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 version 2 as
  15. * published by the Free Software Foundation.
  16. */
  17. #include <linux/interrupt.h>
  18. #include <linux/irq.h>
  19. #include <linux/kernel.h>
  20. #include <linux/module.h>
  21. #include <linux/mutex.h>
  22. #include <linux/slab.h>
  23. #include <linux/gpio.h>
  24. #include <linux/i2c.h>
  25. #include <linux/regulator/of_regulator.h>
  26. #include <linux/mfd/core.h>
  27. #include <linux/mfd/tps6586x.h>
  28. /* GPIO control registers */
  29. #define TPS6586X_GPIOSET1 0x5d
  30. #define TPS6586X_GPIOSET2 0x5e
  31. /* interrupt control registers */
  32. #define TPS6586X_INT_ACK1 0xb5
  33. #define TPS6586X_INT_ACK2 0xb6
  34. #define TPS6586X_INT_ACK3 0xb7
  35. #define TPS6586X_INT_ACK4 0xb8
  36. /* interrupt mask registers */
  37. #define TPS6586X_INT_MASK1 0xb0
  38. #define TPS6586X_INT_MASK2 0xb1
  39. #define TPS6586X_INT_MASK3 0xb2
  40. #define TPS6586X_INT_MASK4 0xb3
  41. #define TPS6586X_INT_MASK5 0xb4
  42. /* device id */
  43. #define TPS6586X_VERSIONCRC 0xcd
  44. struct tps6586x_irq_data {
  45. u8 mask_reg;
  46. u8 mask_mask;
  47. };
  48. #define TPS6586X_IRQ(_reg, _mask) \
  49. { \
  50. .mask_reg = (_reg) - TPS6586X_INT_MASK1, \
  51. .mask_mask = (_mask), \
  52. }
  53. static const struct tps6586x_irq_data tps6586x_irqs[] = {
  54. [TPS6586X_INT_PLDO_0] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 0),
  55. [TPS6586X_INT_PLDO_1] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 1),
  56. [TPS6586X_INT_PLDO_2] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 2),
  57. [TPS6586X_INT_PLDO_3] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 3),
  58. [TPS6586X_INT_PLDO_4] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 4),
  59. [TPS6586X_INT_PLDO_5] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 5),
  60. [TPS6586X_INT_PLDO_6] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 6),
  61. [TPS6586X_INT_PLDO_7] = TPS6586X_IRQ(TPS6586X_INT_MASK1, 1 << 7),
  62. [TPS6586X_INT_COMP_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 0),
  63. [TPS6586X_INT_ADC] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 1),
  64. [TPS6586X_INT_PLDO_8] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 2),
  65. [TPS6586X_INT_PLDO_9] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 3),
  66. [TPS6586X_INT_PSM_0] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 4),
  67. [TPS6586X_INT_PSM_1] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 5),
  68. [TPS6586X_INT_PSM_2] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 6),
  69. [TPS6586X_INT_PSM_3] = TPS6586X_IRQ(TPS6586X_INT_MASK2, 1 << 7),
  70. [TPS6586X_INT_RTC_ALM1] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 4),
  71. [TPS6586X_INT_ACUSB_OVP] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 0x03),
  72. [TPS6586X_INT_USB_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 2),
  73. [TPS6586X_INT_AC_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 3),
  74. [TPS6586X_INT_BAT_DET] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 1 << 0),
  75. [TPS6586X_INT_CHG_STAT] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 0xfc),
  76. [TPS6586X_INT_CHG_TEMP] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 0x06),
  77. [TPS6586X_INT_PP] = TPS6586X_IRQ(TPS6586X_INT_MASK3, 0xf0),
  78. [TPS6586X_INT_RESUME] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 5),
  79. [TPS6586X_INT_LOW_SYS] = TPS6586X_IRQ(TPS6586X_INT_MASK5, 1 << 6),
  80. [TPS6586X_INT_RTC_ALM2] = TPS6586X_IRQ(TPS6586X_INT_MASK4, 1 << 1),
  81. };
  82. struct tps6586x {
  83. struct mutex lock;
  84. struct device *dev;
  85. struct i2c_client *client;
  86. struct gpio_chip gpio;
  87. struct irq_chip irq_chip;
  88. struct mutex irq_lock;
  89. int irq_base;
  90. u32 irq_en;
  91. u8 mask_cache[5];
  92. u8 mask_reg[5];
  93. };
  94. static inline int __tps6586x_read(struct i2c_client *client,
  95. int reg, uint8_t *val)
  96. {
  97. int ret;
  98. ret = i2c_smbus_read_byte_data(client, reg);
  99. if (ret < 0) {
  100. dev_err(&client->dev, "failed reading at 0x%02x\n", reg);
  101. return ret;
  102. }
  103. *val = (uint8_t)ret;
  104. return 0;
  105. }
  106. static inline int __tps6586x_reads(struct i2c_client *client, int reg,
  107. int len, uint8_t *val)
  108. {
  109. int ret;
  110. ret = i2c_smbus_read_i2c_block_data(client, reg, len, val);
  111. if (ret < 0) {
  112. dev_err(&client->dev, "failed reading from 0x%02x\n", reg);
  113. return ret;
  114. }
  115. return 0;
  116. }
  117. static inline int __tps6586x_write(struct i2c_client *client,
  118. int reg, uint8_t val)
  119. {
  120. int ret;
  121. ret = i2c_smbus_write_byte_data(client, reg, val);
  122. if (ret < 0) {
  123. dev_err(&client->dev, "failed writing 0x%02x to 0x%02x\n",
  124. val, reg);
  125. return ret;
  126. }
  127. return 0;
  128. }
  129. static inline int __tps6586x_writes(struct i2c_client *client, int reg,
  130. int len, uint8_t *val)
  131. {
  132. int ret, i;
  133. for (i = 0; i < len; i++) {
  134. ret = __tps6586x_write(client, reg + i, *(val + i));
  135. if (ret < 0)
  136. return ret;
  137. }
  138. return 0;
  139. }
  140. int tps6586x_write(struct device *dev, int reg, uint8_t val)
  141. {
  142. return __tps6586x_write(to_i2c_client(dev), reg, val);
  143. }
  144. EXPORT_SYMBOL_GPL(tps6586x_write);
  145. int tps6586x_writes(struct device *dev, int reg, int len, uint8_t *val)
  146. {
  147. return __tps6586x_writes(to_i2c_client(dev), reg, len, val);
  148. }
  149. EXPORT_SYMBOL_GPL(tps6586x_writes);
  150. int tps6586x_read(struct device *dev, int reg, uint8_t *val)
  151. {
  152. return __tps6586x_read(to_i2c_client(dev), reg, val);
  153. }
  154. EXPORT_SYMBOL_GPL(tps6586x_read);
  155. int tps6586x_reads(struct device *dev, int reg, int len, uint8_t *val)
  156. {
  157. return __tps6586x_reads(to_i2c_client(dev), reg, len, val);
  158. }
  159. EXPORT_SYMBOL_GPL(tps6586x_reads);
  160. int tps6586x_set_bits(struct device *dev, int reg, uint8_t bit_mask)
  161. {
  162. struct tps6586x *tps6586x = dev_get_drvdata(dev);
  163. uint8_t reg_val;
  164. int ret = 0;
  165. mutex_lock(&tps6586x->lock);
  166. ret = __tps6586x_read(to_i2c_client(dev), reg, &reg_val);
  167. if (ret)
  168. goto out;
  169. if ((reg_val & bit_mask) != bit_mask) {
  170. reg_val |= bit_mask;
  171. ret = __tps6586x_write(to_i2c_client(dev), reg, reg_val);
  172. }
  173. out:
  174. mutex_unlock(&tps6586x->lock);
  175. return ret;
  176. }
  177. EXPORT_SYMBOL_GPL(tps6586x_set_bits);
  178. int tps6586x_clr_bits(struct device *dev, int reg, uint8_t bit_mask)
  179. {
  180. struct tps6586x *tps6586x = dev_get_drvdata(dev);
  181. uint8_t reg_val;
  182. int ret = 0;
  183. mutex_lock(&tps6586x->lock);
  184. ret = __tps6586x_read(to_i2c_client(dev), reg, &reg_val);
  185. if (ret)
  186. goto out;
  187. if (reg_val & bit_mask) {
  188. reg_val &= ~bit_mask;
  189. ret = __tps6586x_write(to_i2c_client(dev), reg, reg_val);
  190. }
  191. out:
  192. mutex_unlock(&tps6586x->lock);
  193. return ret;
  194. }
  195. EXPORT_SYMBOL_GPL(tps6586x_clr_bits);
  196. int tps6586x_update(struct device *dev, int reg, uint8_t val, uint8_t mask)
  197. {
  198. struct tps6586x *tps6586x = dev_get_drvdata(dev);
  199. uint8_t reg_val;
  200. int ret = 0;
  201. mutex_lock(&tps6586x->lock);
  202. ret = __tps6586x_read(tps6586x->client, reg, &reg_val);
  203. if (ret)
  204. goto out;
  205. if ((reg_val & mask) != val) {
  206. reg_val = (reg_val & ~mask) | val;
  207. ret = __tps6586x_write(tps6586x->client, reg, reg_val);
  208. }
  209. out:
  210. mutex_unlock(&tps6586x->lock);
  211. return ret;
  212. }
  213. EXPORT_SYMBOL_GPL(tps6586x_update);
  214. static int tps6586x_gpio_get(struct gpio_chip *gc, unsigned offset)
  215. {
  216. struct tps6586x *tps6586x = container_of(gc, struct tps6586x, gpio);
  217. uint8_t val;
  218. int ret;
  219. ret = __tps6586x_read(tps6586x->client, TPS6586X_GPIOSET2, &val);
  220. if (ret)
  221. return ret;
  222. return !!(val & (1 << offset));
  223. }
  224. static void tps6586x_gpio_set(struct gpio_chip *chip, unsigned offset,
  225. int value)
  226. {
  227. struct tps6586x *tps6586x = container_of(chip, struct tps6586x, gpio);
  228. tps6586x_update(tps6586x->dev, TPS6586X_GPIOSET2,
  229. value << offset, 1 << offset);
  230. }
  231. static int tps6586x_gpio_output(struct gpio_chip *gc, unsigned offset,
  232. int value)
  233. {
  234. struct tps6586x *tps6586x = container_of(gc, struct tps6586x, gpio);
  235. uint8_t val, mask;
  236. tps6586x_gpio_set(gc, offset, value);
  237. val = 0x1 << (offset * 2);
  238. mask = 0x3 << (offset * 2);
  239. return tps6586x_update(tps6586x->dev, TPS6586X_GPIOSET1, val, mask);
  240. }
  241. static int tps6586x_gpio_init(struct tps6586x *tps6586x, int gpio_base)
  242. {
  243. if (!gpio_base)
  244. return 0;
  245. tps6586x->gpio.owner = THIS_MODULE;
  246. tps6586x->gpio.label = tps6586x->client->name;
  247. tps6586x->gpio.dev = tps6586x->dev;
  248. tps6586x->gpio.base = gpio_base;
  249. tps6586x->gpio.ngpio = 4;
  250. tps6586x->gpio.can_sleep = 1;
  251. /* FIXME: add handling of GPIOs as dedicated inputs */
  252. tps6586x->gpio.direction_output = tps6586x_gpio_output;
  253. tps6586x->gpio.set = tps6586x_gpio_set;
  254. tps6586x->gpio.get = tps6586x_gpio_get;
  255. return gpiochip_add(&tps6586x->gpio);
  256. }
  257. static int __remove_subdev(struct device *dev, void *unused)
  258. {
  259. platform_device_unregister(to_platform_device(dev));
  260. return 0;
  261. }
  262. static int tps6586x_remove_subdevs(struct tps6586x *tps6586x)
  263. {
  264. return device_for_each_child(tps6586x->dev, NULL, __remove_subdev);
  265. }
  266. static void tps6586x_irq_lock(struct irq_data *data)
  267. {
  268. struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data);
  269. mutex_lock(&tps6586x->irq_lock);
  270. }
  271. static void tps6586x_irq_enable(struct irq_data *irq_data)
  272. {
  273. struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
  274. unsigned int __irq = irq_data->irq - tps6586x->irq_base;
  275. const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq];
  276. tps6586x->mask_reg[data->mask_reg] &= ~data->mask_mask;
  277. tps6586x->irq_en |= (1 << __irq);
  278. }
  279. static void tps6586x_irq_disable(struct irq_data *irq_data)
  280. {
  281. struct tps6586x *tps6586x = irq_data_get_irq_chip_data(irq_data);
  282. unsigned int __irq = irq_data->irq - tps6586x->irq_base;
  283. const struct tps6586x_irq_data *data = &tps6586x_irqs[__irq];
  284. tps6586x->mask_reg[data->mask_reg] |= data->mask_mask;
  285. tps6586x->irq_en &= ~(1 << __irq);
  286. }
  287. static void tps6586x_irq_sync_unlock(struct irq_data *data)
  288. {
  289. struct tps6586x *tps6586x = irq_data_get_irq_chip_data(data);
  290. int i;
  291. for (i = 0; i < ARRAY_SIZE(tps6586x->mask_reg); i++) {
  292. if (tps6586x->mask_reg[i] != tps6586x->mask_cache[i]) {
  293. if (!WARN_ON(tps6586x_write(tps6586x->dev,
  294. TPS6586X_INT_MASK1 + i,
  295. tps6586x->mask_reg[i])))
  296. tps6586x->mask_cache[i] = tps6586x->mask_reg[i];
  297. }
  298. }
  299. mutex_unlock(&tps6586x->irq_lock);
  300. }
  301. static irqreturn_t tps6586x_irq(int irq, void *data)
  302. {
  303. struct tps6586x *tps6586x = data;
  304. u32 acks;
  305. int ret = 0;
  306. ret = tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1,
  307. sizeof(acks), (uint8_t *)&acks);
  308. if (ret < 0) {
  309. dev_err(tps6586x->dev, "failed to read interrupt status\n");
  310. return IRQ_NONE;
  311. }
  312. acks = le32_to_cpu(acks);
  313. while (acks) {
  314. int i = __ffs(acks);
  315. if (tps6586x->irq_en & (1 << i))
  316. handle_nested_irq(tps6586x->irq_base + i);
  317. acks &= ~(1 << i);
  318. }
  319. return IRQ_HANDLED;
  320. }
  321. static int __devinit tps6586x_irq_init(struct tps6586x *tps6586x, int irq,
  322. int irq_base)
  323. {
  324. int i, ret;
  325. u8 tmp[4];
  326. if (!irq_base) {
  327. dev_warn(tps6586x->dev, "No interrupt support on IRQ base\n");
  328. return -EINVAL;
  329. }
  330. mutex_init(&tps6586x->irq_lock);
  331. for (i = 0; i < 5; i++) {
  332. tps6586x->mask_cache[i] = 0xff;
  333. tps6586x->mask_reg[i] = 0xff;
  334. tps6586x_write(tps6586x->dev, TPS6586X_INT_MASK1 + i, 0xff);
  335. }
  336. tps6586x_reads(tps6586x->dev, TPS6586X_INT_ACK1, sizeof(tmp), tmp);
  337. tps6586x->irq_base = irq_base;
  338. tps6586x->irq_chip.name = "tps6586x";
  339. tps6586x->irq_chip.irq_enable = tps6586x_irq_enable;
  340. tps6586x->irq_chip.irq_disable = tps6586x_irq_disable;
  341. tps6586x->irq_chip.irq_bus_lock = tps6586x_irq_lock;
  342. tps6586x->irq_chip.irq_bus_sync_unlock = tps6586x_irq_sync_unlock;
  343. for (i = 0; i < ARRAY_SIZE(tps6586x_irqs); i++) {
  344. int __irq = i + tps6586x->irq_base;
  345. irq_set_chip_data(__irq, tps6586x);
  346. irq_set_chip_and_handler(__irq, &tps6586x->irq_chip,
  347. handle_simple_irq);
  348. irq_set_nested_thread(__irq, 1);
  349. #ifdef CONFIG_ARM
  350. set_irq_flags(__irq, IRQF_VALID);
  351. #endif
  352. }
  353. ret = request_threaded_irq(irq, NULL, tps6586x_irq, IRQF_ONESHOT,
  354. "tps6586x", tps6586x);
  355. if (!ret) {
  356. device_init_wakeup(tps6586x->dev, 1);
  357. enable_irq_wake(irq);
  358. }
  359. return ret;
  360. }
  361. static int __devinit tps6586x_add_subdevs(struct tps6586x *tps6586x,
  362. struct tps6586x_platform_data *pdata)
  363. {
  364. struct tps6586x_subdev_info *subdev;
  365. struct platform_device *pdev;
  366. int i, ret = 0;
  367. for (i = 0; i < pdata->num_subdevs; i++) {
  368. subdev = &pdata->subdevs[i];
  369. pdev = platform_device_alloc(subdev->name, subdev->id);
  370. if (!pdev) {
  371. ret = -ENOMEM;
  372. goto failed;
  373. }
  374. pdev->dev.parent = tps6586x->dev;
  375. pdev->dev.platform_data = subdev->platform_data;
  376. pdev->dev.of_node = subdev->of_node;
  377. ret = platform_device_add(pdev);
  378. if (ret) {
  379. platform_device_put(pdev);
  380. goto failed;
  381. }
  382. }
  383. return 0;
  384. failed:
  385. tps6586x_remove_subdevs(tps6586x);
  386. return ret;
  387. }
  388. #ifdef CONFIG_OF
  389. static struct of_regulator_match tps6586x_matches[] = {
  390. { .name = "sm0", .driver_data = (void *)TPS6586X_ID_SM_0 },
  391. { .name = "sm1", .driver_data = (void *)TPS6586X_ID_SM_1 },
  392. { .name = "sm2", .driver_data = (void *)TPS6586X_ID_SM_2 },
  393. { .name = "ldo0", .driver_data = (void *)TPS6586X_ID_LDO_0 },
  394. { .name = "ldo1", .driver_data = (void *)TPS6586X_ID_LDO_1 },
  395. { .name = "ldo2", .driver_data = (void *)TPS6586X_ID_LDO_2 },
  396. { .name = "ldo3", .driver_data = (void *)TPS6586X_ID_LDO_3 },
  397. { .name = "ldo4", .driver_data = (void *)TPS6586X_ID_LDO_4 },
  398. { .name = "ldo5", .driver_data = (void *)TPS6586X_ID_LDO_5 },
  399. { .name = "ldo6", .driver_data = (void *)TPS6586X_ID_LDO_6 },
  400. { .name = "ldo7", .driver_data = (void *)TPS6586X_ID_LDO_7 },
  401. { .name = "ldo8", .driver_data = (void *)TPS6586X_ID_LDO_8 },
  402. { .name = "ldo9", .driver_data = (void *)TPS6586X_ID_LDO_9 },
  403. { .name = "ldo_rtc", .driver_data = (void *)TPS6586X_ID_LDO_RTC },
  404. };
  405. static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
  406. {
  407. const unsigned int num = ARRAY_SIZE(tps6586x_matches);
  408. struct device_node *np = client->dev.of_node;
  409. struct tps6586x_platform_data *pdata;
  410. struct tps6586x_subdev_info *devs;
  411. struct device_node *regs;
  412. unsigned int count;
  413. unsigned int i, j;
  414. int err;
  415. regs = of_find_node_by_name(np, "regulators");
  416. if (!regs)
  417. return NULL;
  418. err = of_regulator_match(&client->dev, regs, tps6586x_matches, num);
  419. if (err < 0) {
  420. of_node_put(regs);
  421. return NULL;
  422. }
  423. of_node_put(regs);
  424. count = err;
  425. devs = devm_kzalloc(&client->dev, count * sizeof(*devs), GFP_KERNEL);
  426. if (!devs)
  427. return NULL;
  428. for (i = 0, j = 0; i < num && j < count; i++) {
  429. if (!tps6586x_matches[i].init_data)
  430. continue;
  431. devs[j].name = "tps6586x-regulator";
  432. devs[j].platform_data = tps6586x_matches[i].init_data;
  433. devs[j].id = (int)tps6586x_matches[i].driver_data;
  434. devs[j].of_node = tps6586x_matches[i].of_node;
  435. j++;
  436. }
  437. pdata = devm_kzalloc(&client->dev, sizeof(*pdata), GFP_KERNEL);
  438. if (!pdata)
  439. return NULL;
  440. pdata->num_subdevs = count;
  441. pdata->subdevs = devs;
  442. pdata->gpio_base = -1;
  443. pdata->irq_base = -1;
  444. return pdata;
  445. }
  446. static struct of_device_id tps6586x_of_match[] = {
  447. { .compatible = "ti,tps6586x", },
  448. { },
  449. };
  450. #else
  451. static struct tps6586x_platform_data *tps6586x_parse_dt(struct i2c_client *client)
  452. {
  453. return NULL;
  454. }
  455. #endif
  456. static int __devinit tps6586x_i2c_probe(struct i2c_client *client,
  457. const struct i2c_device_id *id)
  458. {
  459. struct tps6586x_platform_data *pdata = client->dev.platform_data;
  460. struct tps6586x *tps6586x;
  461. int ret;
  462. if (!pdata && client->dev.of_node)
  463. pdata = tps6586x_parse_dt(client);
  464. if (!pdata) {
  465. dev_err(&client->dev, "tps6586x requires platform data\n");
  466. return -ENOTSUPP;
  467. }
  468. ret = i2c_smbus_read_byte_data(client, TPS6586X_VERSIONCRC);
  469. if (ret < 0) {
  470. dev_err(&client->dev, "Chip ID read failed: %d\n", ret);
  471. return -EIO;
  472. }
  473. dev_info(&client->dev, "VERSIONCRC is %02x\n", ret);
  474. tps6586x = kzalloc(sizeof(struct tps6586x), GFP_KERNEL);
  475. if (tps6586x == NULL)
  476. return -ENOMEM;
  477. tps6586x->client = client;
  478. tps6586x->dev = &client->dev;
  479. i2c_set_clientdata(client, tps6586x);
  480. mutex_init(&tps6586x->lock);
  481. if (client->irq) {
  482. ret = tps6586x_irq_init(tps6586x, client->irq,
  483. pdata->irq_base);
  484. if (ret) {
  485. dev_err(&client->dev, "IRQ init failed: %d\n", ret);
  486. goto err_irq_init;
  487. }
  488. }
  489. ret = tps6586x_gpio_init(tps6586x, pdata->gpio_base);
  490. if (ret) {
  491. dev_err(&client->dev, "GPIO registration failed: %d\n", ret);
  492. goto err_gpio_init;
  493. }
  494. ret = tps6586x_add_subdevs(tps6586x, pdata);
  495. if (ret) {
  496. dev_err(&client->dev, "add devices failed: %d\n", ret);
  497. goto err_add_devs;
  498. }
  499. return 0;
  500. err_add_devs:
  501. if (pdata->gpio_base) {
  502. ret = gpiochip_remove(&tps6586x->gpio);
  503. if (ret)
  504. dev_err(&client->dev, "Can't remove gpio chip: %d\n",
  505. ret);
  506. }
  507. err_gpio_init:
  508. if (client->irq)
  509. free_irq(client->irq, tps6586x);
  510. err_irq_init:
  511. kfree(tps6586x);
  512. return ret;
  513. }
  514. static int __devexit tps6586x_i2c_remove(struct i2c_client *client)
  515. {
  516. struct tps6586x *tps6586x = i2c_get_clientdata(client);
  517. struct tps6586x_platform_data *pdata = client->dev.platform_data;
  518. int ret;
  519. if (client->irq)
  520. free_irq(client->irq, tps6586x);
  521. if (pdata->gpio_base) {
  522. ret = gpiochip_remove(&tps6586x->gpio);
  523. if (ret)
  524. dev_err(&client->dev, "Can't remove gpio chip: %d\n",
  525. ret);
  526. }
  527. tps6586x_remove_subdevs(tps6586x);
  528. kfree(tps6586x);
  529. return 0;
  530. }
  531. static const struct i2c_device_id tps6586x_id_table[] = {
  532. { "tps6586x", 0 },
  533. { },
  534. };
  535. MODULE_DEVICE_TABLE(i2c, tps6586x_id_table);
  536. static struct i2c_driver tps6586x_driver = {
  537. .driver = {
  538. .name = "tps6586x",
  539. .owner = THIS_MODULE,
  540. .of_match_table = of_match_ptr(tps6586x_of_match),
  541. },
  542. .probe = tps6586x_i2c_probe,
  543. .remove = __devexit_p(tps6586x_i2c_remove),
  544. .id_table = tps6586x_id_table,
  545. };
  546. static int __init tps6586x_init(void)
  547. {
  548. return i2c_add_driver(&tps6586x_driver);
  549. }
  550. subsys_initcall(tps6586x_init);
  551. static void __exit tps6586x_exit(void)
  552. {
  553. i2c_del_driver(&tps6586x_driver);
  554. }
  555. module_exit(tps6586x_exit);
  556. MODULE_DESCRIPTION("TPS6586X core driver");
  557. MODULE_AUTHOR("Mike Rapoport <mike@compulab.co.il>");
  558. MODULE_LICENSE("GPL");