mfd: Make jz4740_adc_driver static
[linux-2.6.git] / drivers / mfd / tps65912-core.c
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;
127         struct tps65912_platform_data *init_data;
128         int ret, dcdc_avs, value;
129
130         init_data = kzalloc(sizeof(struct tps65912_platform_data), GFP_KERNEL);
131         if (init_data == NULL)
132                 return -ENOMEM;
133
134         init_data->irq = pmic_plat_data->irq;
135         init_data->irq_base = pmic_plat_data->irq;
136
137         mutex_init(&tps65912->io_mutex);
138         dev_set_drvdata(tps65912->dev, tps65912);
139
140         dcdc_avs = (pmic_plat_data->is_dcdc1_avs << 0 |
141                         pmic_plat_data->is_dcdc2_avs  << 1 |
142                                 pmic_plat_data->is_dcdc3_avs << 2 |
143                                         pmic_plat_data->is_dcdc4_avs << 3);
144         if (dcdc_avs) {
145                 tps65912->read(tps65912, TPS65912_I2C_SPI_CFG, 1, &value);
146                 dcdc_avs |= value;
147                 tps65912->write(tps65912, TPS65912_I2C_SPI_CFG, 1, &dcdc_avs);
148         }
149
150         ret = mfd_add_devices(tps65912->dev, -1,
151                               tps65912s, ARRAY_SIZE(tps65912s),
152                               NULL, 0);
153         if (ret < 0)
154                 goto err;
155
156         ret = tps65912_irq_init(tps65912, init_data->irq, init_data);
157         if (ret < 0)
158                 goto err;
159
160         return ret;
161
162 err:
163         kfree(init_data);
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);
172         kfree(tps65912);
173 }
174
175 MODULE_AUTHOR("Margarita Olaya  <magi@slimlogic.co.uk>");
176 MODULE_DESCRIPTION("TPS65912x chip family multi-function driver");
177 MODULE_LICENSE("GPL");