blob: bd4b37ce254e768accf4a6d4240667a50c546320 [file] [log] [blame]
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -07001/*
2 * Copyright (c) 2011, Code Aurora Forum. All rights reserved.
3 *
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 and
6 * only version 2 as published by the Free Software Foundation.
7 *
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
12 */
13
14#define pr_fmt(fmt) "%s: " fmt, __func__
15
16#include <linux/kernel.h>
Jingoo Hanef310f42013-08-20 16:01:26 +090017#include <linux/module.h>
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070018#include <linux/platform_device.h>
19#include <linux/slab.h>
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -070020#include <linux/err.h>
David Brownce44bf52013-03-12 11:41:54 -070021#include <linux/ssbi.h>
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070022#include <linux/mfd/core.h>
23#include <linux/mfd/pm8xxx/pm8921.h>
24#include <linux/mfd/pm8xxx/core.h>
25
26#define REG_HWREV 0x002 /* PMIC4 revision */
27#define REG_HWREV_2 0x0E8 /* PMIC4 revision 2 */
28
29struct pm8921 {
30 struct device *dev;
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -070031 struct pm_irq_chip *irq_chip;
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070032};
33
34static int pm8921_readb(const struct device *dev, u16 addr, u8 *val)
35{
36 const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
37 const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;
38
David Brownce44bf52013-03-12 11:41:54 -070039 return ssbi_read(pmic->dev->parent, addr, val, 1);
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070040}
41
42static int pm8921_writeb(const struct device *dev, u16 addr, u8 val)
43{
44 const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
45 const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;
46
David Brownce44bf52013-03-12 11:41:54 -070047 return ssbi_write(pmic->dev->parent, addr, &val, 1);
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070048}
49
50static int pm8921_read_buf(const struct device *dev, u16 addr, u8 *buf,
51 int cnt)
52{
53 const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
54 const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;
55
David Brownce44bf52013-03-12 11:41:54 -070056 return ssbi_read(pmic->dev->parent, addr, buf, cnt);
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070057}
58
59static int pm8921_write_buf(const struct device *dev, u16 addr, u8 *buf,
60 int cnt)
61{
62 const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
63 const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;
64
David Brownce44bf52013-03-12 11:41:54 -070065 return ssbi_write(pmic->dev->parent, addr, buf, cnt);
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070066}
67
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -070068static int pm8921_read_irq_stat(const struct device *dev, int irq)
69{
70 const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
71 const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;
72
73 return pm8xxx_get_irq_stat(pmic->irq_chip, irq);
74}
75
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070076static struct pm8xxx_drvdata pm8921_drvdata = {
77 .pmic_readb = pm8921_readb,
78 .pmic_writeb = pm8921_writeb,
79 .pmic_read_buf = pm8921_read_buf,
80 .pmic_write_buf = pm8921_write_buf,
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -070081 .pmic_read_irq_stat = pm8921_read_irq_stat,
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -070082};
83
Bill Pembertonf791be42012-11-19 13:23:04 -050084static int pm8921_add_subdevices(const struct pm8921_platform_data
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -070085 *pdata,
86 struct pm8921 *pmic,
87 u32 rev)
88{
89 int ret = 0, irq_base = 0;
90 struct pm_irq_chip *irq_chip;
91
92 if (pdata->irq_pdata) {
93 pdata->irq_pdata->irq_cdata.nirqs = PM8921_NR_IRQS;
94 pdata->irq_pdata->irq_cdata.rev = rev;
95 irq_base = pdata->irq_pdata->irq_base;
96 irq_chip = pm8xxx_irq_init(pmic->dev, pdata->irq_pdata);
97
98 if (IS_ERR(irq_chip)) {
99 pr_err("Failed to init interrupts ret=%ld\n",
100 PTR_ERR(irq_chip));
101 return PTR_ERR(irq_chip);
102 }
103 pmic->irq_chip = irq_chip;
104 }
105 return ret;
106}
107
Bill Pembertonf791be42012-11-19 13:23:04 -0500108static int pm8921_probe(struct platform_device *pdev)
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700109{
Jingoo Han334a41c2013-07-30 17:10:05 +0900110 const struct pm8921_platform_data *pdata = dev_get_platdata(&pdev->dev);
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700111 struct pm8921 *pmic;
112 int rc;
113 u8 val;
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -0700114 u32 rev;
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700115
116 if (!pdata) {
117 pr_err("missing platform data\n");
118 return -EINVAL;
119 }
120
121 pmic = kzalloc(sizeof(struct pm8921), GFP_KERNEL);
122 if (!pmic) {
123 pr_err("Cannot alloc pm8921 struct\n");
124 return -ENOMEM;
125 }
126
127 /* Read PMIC chip revision */
David Brownce44bf52013-03-12 11:41:54 -0700128 rc = ssbi_read(pdev->dev.parent, REG_HWREV, &val, sizeof(val));
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700129 if (rc) {
130 pr_err("Failed to read hw rev reg %d:rc=%d\n", REG_HWREV, rc);
131 goto err_read_rev;
132 }
133 pr_info("PMIC revision 1: %02X\n", val);
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -0700134 rev = val;
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700135
136 /* Read PMIC chip revision 2 */
David Brownce44bf52013-03-12 11:41:54 -0700137 rc = ssbi_read(pdev->dev.parent, REG_HWREV_2, &val, sizeof(val));
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700138 if (rc) {
139 pr_err("Failed to read hw rev 2 reg %d:rc=%d\n",
140 REG_HWREV_2, rc);
141 goto err_read_rev;
142 }
143 pr_info("PMIC revision 2: %02X\n", val);
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -0700144 rev |= val << BITS_PER_BYTE;
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700145
146 pmic->dev = &pdev->dev;
147 pm8921_drvdata.pm_chip_data = pmic;
148 platform_set_drvdata(pdev, &pm8921_drvdata);
149
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -0700150 rc = pm8921_add_subdevices(pdata, pmic, rev);
151 if (rc) {
152 pr_err("Cannot add subdevices rc=%d\n", rc);
153 goto err;
154 }
155
156 /* gpio might not work if no irq device is found */
157 WARN_ON(pmic->irq_chip == NULL);
158
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700159 return 0;
160
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -0700161err:
162 mfd_remove_devices(pmic->dev);
163 platform_set_drvdata(pdev, NULL);
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700164err_read_rev:
165 kfree(pmic);
166 return rc;
167}
168
Bill Pemberton4740f732012-11-19 13:26:01 -0500169static int pm8921_remove(struct platform_device *pdev)
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700170{
171 struct pm8xxx_drvdata *drvdata;
172 struct pm8921 *pmic = NULL;
173
174 drvdata = platform_get_drvdata(pdev);
175 if (drvdata)
176 pmic = drvdata->pm_chip_data;
177 if (pmic)
178 mfd_remove_devices(pmic->dev);
Abhijeet Dharmapurikarc013f0a2011-04-05 14:40:53 -0700179 if (pmic->irq_chip) {
180 pm8xxx_irq_exit(pmic->irq_chip);
181 pmic->irq_chip = NULL;
182 }
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700183 platform_set_drvdata(pdev, NULL);
184 kfree(pmic);
185
186 return 0;
187}
188
189static struct platform_driver pm8921_driver = {
190 .probe = pm8921_probe,
Bill Pemberton84449212012-11-19 13:20:24 -0500191 .remove = pm8921_remove,
Abhijeet Dharmapurikarcbdb53e2011-04-05 14:40:52 -0700192 .driver = {
193 .name = "pm8921-core",
194 .owner = THIS_MODULE,
195 },
196};
197
198static int __init pm8921_init(void)
199{
200 return platform_driver_register(&pm8921_driver);
201}
202subsys_initcall(pm8921_init);
203
204static void __exit pm8921_exit(void)
205{
206 platform_driver_unregister(&pm8921_driver);
207}
208module_exit(pm8921_exit);
209
210MODULE_LICENSE("GPL v2");
211MODULE_DESCRIPTION("PMIC 8921 core driver");
212MODULE_VERSION("1.0");
213MODULE_ALIAS("platform:pm8921-core");