]>
Commit | Line | Data |
---|---|---|
36e52873 MO |
1 | /* |
2 | * tps65912-core.c -- TI TPS65912x | |
3 | * | |
4 | * Copyright 2011 Texas Instruments Inc. | |
5 | * | |
6 | * Author: Margarita Olaya Cabrera <magi@slimlogic.co.uk> | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify it | |
9 | * under the terms of the GNU General Public License as published by the | |
10 | * Free Software Foundation; either version 2 of the License, or (at your | |
11 | * option) any later version. | |
12 | * | |
13 | * This driver is based on wm8350 implementation. | |
14 | */ | |
15 | ||
16 | #include <linux/module.h> | |
17 | #include <linux/moduleparam.h> | |
18 | #include <linux/init.h> | |
19 | #include <linux/slab.h> | |
20 | #include <linux/gpio.h> | |
21 | #include <linux/mfd/core.h> | |
22 | #include <linux/mfd/tps65912.h> | |
23 | ||
24 | static struct mfd_cell tps65912s[] = { | |
25 | { | |
26 | .name = "tps65912-pmic", | |
27 | }, | |
28 | }; | |
29 | ||
30 | int tps65912_set_bits(struct tps65912 *tps65912, u8 reg, u8 mask) | |
31 | { | |
32 | u8 data; | |
33 | int err; | |
34 | ||
35 | mutex_lock(&tps65912->io_mutex); | |
36 | ||
37 | err = tps65912->read(tps65912, reg, 1, &data); | |
38 | if (err) { | |
39 | dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); | |
40 | goto out; | |
41 | } | |
42 | ||
43 | data |= mask; | |
44 | err = tps65912->write(tps65912, reg, 1, &data); | |
45 | if (err) | |
46 | dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg); | |
47 | ||
48 | out: | |
49 | mutex_unlock(&tps65912->io_mutex); | |
50 | return err; | |
51 | } | |
52 | EXPORT_SYMBOL_GPL(tps65912_set_bits); | |
53 | ||
54 | int tps65912_clear_bits(struct tps65912 *tps65912, u8 reg, u8 mask) | |
55 | { | |
56 | u8 data; | |
57 | int err; | |
58 | ||
59 | mutex_lock(&tps65912->io_mutex); | |
60 | err = tps65912->read(tps65912, reg, 1, &data); | |
61 | if (err) { | |
62 | dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); | |
63 | goto out; | |
64 | } | |
65 | ||
66 | data &= ~mask; | |
67 | err = tps65912->write(tps65912, reg, 1, &data); | |
68 | if (err) | |
69 | dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg); | |
70 | ||
71 | out: | |
72 | mutex_unlock(&tps65912->io_mutex); | |
73 | return err; | |
74 | } | |
75 | EXPORT_SYMBOL_GPL(tps65912_clear_bits); | |
76 | ||
77 | static inline int tps65912_read(struct tps65912 *tps65912, u8 reg) | |
78 | { | |
79 | u8 val; | |
80 | int err; | |
81 | ||
82 | err = tps65912->read(tps65912, reg, 1, &val); | |
83 | if (err < 0) | |
84 | return err; | |
85 | ||
86 | return val; | |
87 | } | |
88 | ||
89 | static inline int tps65912_write(struct tps65912 *tps65912, u8 reg, u8 val) | |
90 | { | |
91 | return tps65912->write(tps65912, reg, 1, &val); | |
92 | } | |
93 | ||
94 | int tps65912_reg_read(struct tps65912 *tps65912, u8 reg) | |
95 | { | |
96 | int data; | |
97 | ||
98 | mutex_lock(&tps65912->io_mutex); | |
99 | ||
100 | data = tps65912_read(tps65912, reg); | |
101 | if (data < 0) | |
102 | dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg); | |
103 | ||
104 | mutex_unlock(&tps65912->io_mutex); | |
105 | return data; | |
106 | } | |
107 | EXPORT_SYMBOL_GPL(tps65912_reg_read); | |
108 | ||
109 | int tps65912_reg_write(struct tps65912 *tps65912, u8 reg, u8 val) | |
110 | { | |
111 | int err; | |
112 | ||
113 | mutex_lock(&tps65912->io_mutex); | |
114 | ||
115 | err = tps65912_write(tps65912, reg, val); | |
116 | if (err < 0) | |
117 | dev_err(tps65912->dev, "Write for reg 0x%x failed\n", reg); | |
118 | ||
119 | mutex_unlock(&tps65912->io_mutex); | |
120 | return err; | |
121 | } | |
122 | EXPORT_SYMBOL_GPL(tps65912_reg_write); | |
123 | ||
124 | int tps65912_device_init(struct tps65912 *tps65912) | |
125 | { | |
126 | struct tps65912_board *pmic_plat_data = tps65912->dev->platform_data; | |
d49a0f3f | 127 | struct tps65912_platform_data *init_data; |
36e52873 MO |
128 | int ret, dcdc_avs, value; |
129 | ||
d49a0f3f MO |
130 | init_data = kzalloc(sizeof(struct tps65912_platform_data), GFP_KERNEL); |
131 | if (init_data == NULL) | |
132 | return -ENOMEM; | |
133 | ||
36e52873 MO |
134 | mutex_init(&tps65912->io_mutex); |
135 | dev_set_drvdata(tps65912->dev, tps65912); | |
136 | ||
137 | dcdc_avs = (pmic_plat_data->is_dcdc1_avs << 0 | | |
138 | pmic_plat_data->is_dcdc2_avs << 1 | | |
139 | pmic_plat_data->is_dcdc3_avs << 2 | | |
140 | pmic_plat_data->is_dcdc4_avs << 3); | |
141 | if (dcdc_avs) { | |
142 | tps65912->read(tps65912, TPS65912_I2C_SPI_CFG, 1, &value); | |
143 | dcdc_avs |= value; | |
144 | tps65912->write(tps65912, TPS65912_I2C_SPI_CFG, 1, &dcdc_avs); | |
145 | } | |
146 | ||
147 | ret = mfd_add_devices(tps65912->dev, -1, | |
148 | tps65912s, ARRAY_SIZE(tps65912s), | |
0848c94f | 149 | NULL, 0, NULL); |
36e52873 MO |
150 | if (ret < 0) |
151 | goto err; | |
152 | ||
677df0c9 | 153 | init_data->irq = pmic_plat_data->irq; |
d5f39d38 | 154 | init_data->irq_base = pmic_plat_data->irq_base; |
d49a0f3f MO |
155 | ret = tps65912_irq_init(tps65912, init_data->irq, init_data); |
156 | if (ret < 0) | |
157 | goto err; | |
158 | ||
677df0c9 | 159 | kfree(init_data); |
36e52873 MO |
160 | return ret; |
161 | ||
162 | err: | |
d49a0f3f | 163 | kfree(init_data); |
36e52873 MO |
164 | mfd_remove_devices(tps65912->dev); |
165 | kfree(tps65912); | |
166 | return ret; | |
167 | } | |
168 | ||
169 | void tps65912_device_exit(struct tps65912 *tps65912) | |
170 | { | |
171 | mfd_remove_devices(tps65912->dev); | |
80e4e671 | 172 | tps65912_irq_exit(tps65912); |
36e52873 MO |
173 | kfree(tps65912); |
174 | } | |
175 | ||
176 | MODULE_AUTHOR("Margarita Olaya <magi@slimlogic.co.uk>"); | |
177 | MODULE_DESCRIPTION("TPS65912x chip family multi-function driver"); | |
178 | MODULE_LICENSE("GPL"); |