This source file includes following definitions.
- goldfish_ac_get_property
- goldfish_battery_get_property
- goldfish_battery_interrupt
- goldfish_battery_probe
- goldfish_battery_remove
1
2
3
4
5
6
7
8
9
10
11 #include <linux/module.h>
12 #include <linux/err.h>
13 #include <linux/platform_device.h>
14 #include <linux/power_supply.h>
15 #include <linux/types.h>
16 #include <linux/pci.h>
17 #include <linux/interrupt.h>
18 #include <linux/io.h>
19 #include <linux/acpi.h>
20
21 struct goldfish_battery_data {
22 void __iomem *reg_base;
23 int irq;
24 spinlock_t lock;
25
26 struct power_supply *battery;
27 struct power_supply *ac;
28 };
29
30 #define GOLDFISH_BATTERY_READ(data, addr) \
31 (readl(data->reg_base + addr))
32 #define GOLDFISH_BATTERY_WRITE(data, addr, x) \
33 (writel(x, data->reg_base + addr))
34
35 enum {
36
37 BATTERY_INT_STATUS = 0x00,
38
39 BATTERY_INT_ENABLE = 0x04,
40
41 BATTERY_AC_ONLINE = 0x08,
42 BATTERY_STATUS = 0x0C,
43 BATTERY_HEALTH = 0x10,
44 BATTERY_PRESENT = 0x14,
45 BATTERY_CAPACITY = 0x18,
46 BATTERY_VOLTAGE = 0x1C,
47 BATTERY_TEMP = 0x20,
48 BATTERY_CHARGE_COUNTER = 0x24,
49 BATTERY_VOLTAGE_MAX = 0x28,
50 BATTERY_CURRENT_MAX = 0x2C,
51 BATTERY_CURRENT_NOW = 0x30,
52 BATTERY_CURRENT_AVG = 0x34,
53 BATTERY_CHARGE_FULL_UAH = 0x38,
54 BATTERY_CYCLE_COUNT = 0x40,
55
56 BATTERY_STATUS_CHANGED = 1U << 0,
57 AC_STATUS_CHANGED = 1U << 1,
58 BATTERY_INT_MASK = BATTERY_STATUS_CHANGED | AC_STATUS_CHANGED,
59 };
60
61
62 static int goldfish_ac_get_property(struct power_supply *psy,
63 enum power_supply_property psp,
64 union power_supply_propval *val)
65 {
66 struct goldfish_battery_data *data = power_supply_get_drvdata(psy);
67 int ret = 0;
68
69 switch (psp) {
70 case POWER_SUPPLY_PROP_ONLINE:
71 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_AC_ONLINE);
72 break;
73 case POWER_SUPPLY_PROP_VOLTAGE_MAX:
74 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_VOLTAGE_MAX);
75 break;
76 case POWER_SUPPLY_PROP_CURRENT_MAX:
77 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CURRENT_MAX);
78 break;
79 default:
80 ret = -EINVAL;
81 break;
82 }
83 return ret;
84 }
85
86 static int goldfish_battery_get_property(struct power_supply *psy,
87 enum power_supply_property psp,
88 union power_supply_propval *val)
89 {
90 struct goldfish_battery_data *data = power_supply_get_drvdata(psy);
91 int ret = 0;
92
93 switch (psp) {
94 case POWER_SUPPLY_PROP_STATUS:
95 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_STATUS);
96 break;
97 case POWER_SUPPLY_PROP_HEALTH:
98 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_HEALTH);
99 break;
100 case POWER_SUPPLY_PROP_PRESENT:
101 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_PRESENT);
102 break;
103 case POWER_SUPPLY_PROP_TECHNOLOGY:
104 val->intval = POWER_SUPPLY_TECHNOLOGY_LION;
105 break;
106 case POWER_SUPPLY_PROP_CAPACITY:
107 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CAPACITY);
108 break;
109 case POWER_SUPPLY_PROP_VOLTAGE_NOW:
110 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_VOLTAGE);
111 break;
112 case POWER_SUPPLY_PROP_TEMP:
113 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_TEMP);
114 break;
115 case POWER_SUPPLY_PROP_CHARGE_COUNTER:
116 val->intval = GOLDFISH_BATTERY_READ(data,
117 BATTERY_CHARGE_COUNTER);
118 break;
119 case POWER_SUPPLY_PROP_CURRENT_NOW:
120 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CURRENT_NOW);
121 break;
122 case POWER_SUPPLY_PROP_CURRENT_AVG:
123 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CURRENT_AVG);
124 break;
125 case POWER_SUPPLY_PROP_CHARGE_FULL:
126 val->intval = GOLDFISH_BATTERY_READ(data,
127 BATTERY_CHARGE_FULL_UAH);
128 break;
129 case POWER_SUPPLY_PROP_CYCLE_COUNT:
130 val->intval = GOLDFISH_BATTERY_READ(data, BATTERY_CYCLE_COUNT);
131 break;
132 default:
133 ret = -EINVAL;
134 break;
135 }
136
137 return ret;
138 }
139
140 static enum power_supply_property goldfish_battery_props[] = {
141 POWER_SUPPLY_PROP_STATUS,
142 POWER_SUPPLY_PROP_HEALTH,
143 POWER_SUPPLY_PROP_PRESENT,
144 POWER_SUPPLY_PROP_TECHNOLOGY,
145 POWER_SUPPLY_PROP_CAPACITY,
146 POWER_SUPPLY_PROP_VOLTAGE_NOW,
147 POWER_SUPPLY_PROP_TEMP,
148 POWER_SUPPLY_PROP_CHARGE_COUNTER,
149 POWER_SUPPLY_PROP_CURRENT_NOW,
150 POWER_SUPPLY_PROP_CURRENT_AVG,
151 POWER_SUPPLY_PROP_CHARGE_FULL,
152 POWER_SUPPLY_PROP_CYCLE_COUNT,
153 };
154
155 static enum power_supply_property goldfish_ac_props[] = {
156 POWER_SUPPLY_PROP_ONLINE,
157 POWER_SUPPLY_PROP_VOLTAGE_MAX,
158 POWER_SUPPLY_PROP_CURRENT_MAX,
159 };
160
161 static irqreturn_t goldfish_battery_interrupt(int irq, void *dev_id)
162 {
163 unsigned long irq_flags;
164 struct goldfish_battery_data *data = dev_id;
165 uint32_t status;
166
167 spin_lock_irqsave(&data->lock, irq_flags);
168
169
170 status = GOLDFISH_BATTERY_READ(data, BATTERY_INT_STATUS);
171 status &= BATTERY_INT_MASK;
172
173 if (status & BATTERY_STATUS_CHANGED)
174 power_supply_changed(data->battery);
175 if (status & AC_STATUS_CHANGED)
176 power_supply_changed(data->ac);
177
178 spin_unlock_irqrestore(&data->lock, irq_flags);
179 return status ? IRQ_HANDLED : IRQ_NONE;
180 }
181
182 static const struct power_supply_desc battery_desc = {
183 .properties = goldfish_battery_props,
184 .num_properties = ARRAY_SIZE(goldfish_battery_props),
185 .get_property = goldfish_battery_get_property,
186 .name = "battery",
187 .type = POWER_SUPPLY_TYPE_BATTERY,
188 };
189
190 static const struct power_supply_desc ac_desc = {
191 .properties = goldfish_ac_props,
192 .num_properties = ARRAY_SIZE(goldfish_ac_props),
193 .get_property = goldfish_ac_get_property,
194 .name = "ac",
195 .type = POWER_SUPPLY_TYPE_MAINS,
196 };
197
198 static int goldfish_battery_probe(struct platform_device *pdev)
199 {
200 int ret;
201 struct resource *r;
202 struct goldfish_battery_data *data;
203 struct power_supply_config psy_cfg = {};
204
205 data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
206 if (data == NULL)
207 return -ENOMEM;
208
209 spin_lock_init(&data->lock);
210
211 r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
212 if (r == NULL) {
213 dev_err(&pdev->dev, "platform_get_resource failed\n");
214 return -ENODEV;
215 }
216
217 data->reg_base = devm_ioremap(&pdev->dev, r->start, resource_size(r));
218 if (data->reg_base == NULL) {
219 dev_err(&pdev->dev, "unable to remap MMIO\n");
220 return -ENOMEM;
221 }
222
223 data->irq = platform_get_irq(pdev, 0);
224 if (data->irq < 0) {
225 dev_err(&pdev->dev, "platform_get_irq failed\n");
226 return -ENODEV;
227 }
228
229 ret = devm_request_irq(&pdev->dev, data->irq,
230 goldfish_battery_interrupt,
231 IRQF_SHARED, pdev->name, data);
232 if (ret)
233 return ret;
234
235 psy_cfg.drv_data = data;
236
237 data->ac = power_supply_register(&pdev->dev, &ac_desc, &psy_cfg);
238 if (IS_ERR(data->ac))
239 return PTR_ERR(data->ac);
240
241 data->battery = power_supply_register(&pdev->dev, &battery_desc,
242 &psy_cfg);
243 if (IS_ERR(data->battery)) {
244 power_supply_unregister(data->ac);
245 return PTR_ERR(data->battery);
246 }
247
248 platform_set_drvdata(pdev, data);
249
250 GOLDFISH_BATTERY_WRITE(data, BATTERY_INT_ENABLE, BATTERY_INT_MASK);
251 return 0;
252 }
253
254 static int goldfish_battery_remove(struct platform_device *pdev)
255 {
256 struct goldfish_battery_data *data = platform_get_drvdata(pdev);
257
258 power_supply_unregister(data->battery);
259 power_supply_unregister(data->ac);
260 return 0;
261 }
262
263 static const struct of_device_id goldfish_battery_of_match[] = {
264 { .compatible = "google,goldfish-battery", },
265 {},
266 };
267 MODULE_DEVICE_TABLE(of, goldfish_battery_of_match);
268
269 static const struct acpi_device_id goldfish_battery_acpi_match[] = {
270 { "GFSH0001", 0 },
271 { },
272 };
273 MODULE_DEVICE_TABLE(acpi, goldfish_battery_acpi_match);
274
275 static struct platform_driver goldfish_battery_device = {
276 .probe = goldfish_battery_probe,
277 .remove = goldfish_battery_remove,
278 .driver = {
279 .name = "goldfish-battery",
280 .of_match_table = goldfish_battery_of_match,
281 .acpi_match_table = ACPI_PTR(goldfish_battery_acpi_match),
282 }
283 };
284 module_platform_driver(goldfish_battery_device);
285
286 MODULE_AUTHOR("Mike Lockwood lockwood@android.com");
287 MODULE_LICENSE("GPL");
288 MODULE_DESCRIPTION("Battery driver for the Goldfish emulator");