hc
2024-08-16 a24a44ff9ca902811b99aa9663d697cf452e08ef
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
// SPDX-License-Identifier: GPL-2.0
/*
 * Copyright (c) 2020 Rockchip Electronics Co. Ltd.
 *
 * Author: Guochun Huang <hero.huang@rock-chips.com>
 */
 
#include <linux/delay.h>
#include <linux/err.h>
#include <linux/gpio/consumer.h>
#include <linux/i2c.h>
#include <linux/module.h>
#include <linux/regmap.h>
#include <linux/regulator/driver.h>
#include <linux/regulator/machine.h>
 
#define DIO5632_REG_VPOS        0x00
#define DIO5632_REG_VNEG        0x01
#define DIO5632_REG_APPS_DISP_DISN    0x03
#define DIO5632_REG_CONTROL        0x0FF
 
#define DIO5632_VOUT_MASK        0x1F
#define DIO5632_VOUT_N_VOLTAGE        0x15
#define DIO5632_VOUT_VMIN        4000000
#define DIO5632_VOUT_VMAX        6000000
#define DIO5632_VOUT_STEP        100000
 
#define DIO5632_REG_DIS_VPOS        BIT(1)
#define DIO5632_REG_DIS_VNEG        BIT(0)
 
#define DIO5632_REGULATOR_ID_VPOS    0
#define DIO5632_REGULATOR_ID_VNEG    1
#define DIO5632_MAX_REGULATORS        2
 
#define DIO5632_ACT_DIS_TIME_SLACK        1000
 
struct DIO5632_reg_pdata {
   struct gpio_desc *en_gpiod;
   int ena_gpio_state;
};
 
struct DIO5632_regulator {
   struct device *dev;
   struct DIO5632_reg_pdata reg_pdata[DIO5632_MAX_REGULATORS];
};
 
static int DIO5632_regulator_enable(struct regulator_dev *rdev)
{
   struct DIO5632_regulator *dio = rdev_get_drvdata(rdev);
   int id = rdev_get_id(rdev);
   struct DIO5632_reg_pdata *rpdata = &dio->reg_pdata[id];
   int ret;
 
   if (!IS_ERR(rpdata->en_gpiod)) {
       gpiod_set_value_cansleep(rpdata->en_gpiod, 1);
       rpdata->ena_gpio_state = 1;
   }
 
   /* Hardware automatically enable discharge bit in enable */
   if (rdev->constraints->active_discharge ==
           REGULATOR_ACTIVE_DISCHARGE_DISABLE) {
       ret = regulator_set_active_discharge_regmap(rdev, false);
       if (ret < 0) {
           dev_err(dio->dev, "Failed to disable active discharge: %d\n",
               ret);
           return ret;
       }
   }
 
   return 0;
}
 
static int DIO5632_regulator_disable(struct regulator_dev *rdev)
{
   struct DIO5632_regulator *dio = rdev_get_drvdata(rdev);
   int id = rdev_get_id(rdev);
   struct DIO5632_reg_pdata *rpdata = &dio->reg_pdata[id];
 
   if (!IS_ERR(rpdata->en_gpiod)) {
       gpiod_set_value_cansleep(rpdata->en_gpiod, 0);
       rpdata->ena_gpio_state = 0;
   }
 
   return 0;
}
 
static int DIO5632_regulator_is_enabled(struct regulator_dev *rdev)
{
   struct DIO5632_regulator *dio = rdev_get_drvdata(rdev);
   int id = rdev_get_id(rdev);
   struct DIO5632_reg_pdata *rpdata = &dio->reg_pdata[id];
 
   if (!IS_ERR(rpdata->en_gpiod))
       return rpdata->ena_gpio_state;
 
   return 1;
}
 
static const struct regulator_ops DIO5632_regulator_ops = {
   .enable = DIO5632_regulator_enable,
   .disable = DIO5632_regulator_disable,
   .is_enabled = DIO5632_regulator_is_enabled,
   .list_voltage = regulator_list_voltage_linear,
   .map_voltage = regulator_map_voltage_linear,
   .get_voltage_sel = regulator_get_voltage_sel_regmap,
   .set_voltage_sel = regulator_set_voltage_sel_regmap,
   .set_active_discharge = regulator_set_active_discharge_regmap,
};
 
static int DIO5632_of_parse_cb(struct device_node *np,
               const struct regulator_desc *desc,
               struct regulator_config *config)
{
   struct DIO5632_regulator *dio = config->driver_data;
   struct DIO5632_reg_pdata *rpdata = &dio->reg_pdata[desc->id];
   int ret;
 
   rpdata->en_gpiod = devm_fwnode_get_index_gpiod_from_child(dio->dev,
                   "enable", 0, &np->fwnode,
                   GPIOD_OUT_HIGH, "enable");
   if (IS_ERR_OR_NULL(rpdata->en_gpiod)) {
       ret = PTR_ERR(rpdata->en_gpiod);
 
       /* Ignore the error other than probe defer */
       if (ret == -EPROBE_DEFER)
           return ret;
       return 0;
   }
 
   return 0;
}
 
#define DIO5632_REGULATOR_DESC(_id, _name)        \
   [DIO5632_REGULATOR_ID_##_id] = {        \
       .name = "DIO5632-"#_name,        \
       .supply_name = "vin",            \
       .id = DIO5632_REGULATOR_ID_##_id,    \
       .of_match = of_match_ptr(#_name),    \
       .of_parse_cb    = DIO5632_of_parse_cb,    \
       .ops = &DIO5632_regulator_ops,        \
       .n_voltages = DIO5632_VOUT_N_VOLTAGE,    \
       .min_uV = DIO5632_VOUT_VMIN,        \
       .uV_step = DIO5632_VOUT_STEP,        \
       .enable_time = 500,            \
       .vsel_mask = DIO5632_VOUT_MASK,    \
       .vsel_reg = DIO5632_REG_##_id,        \
       .active_discharge_off = 0,            \
       .active_discharge_on = DIO5632_REG_DIS_##_id, \
       .active_discharge_mask = DIO5632_REG_DIS_##_id, \
       .active_discharge_reg = DIO5632_REG_APPS_DISP_DISN, \
       .type = REGULATOR_VOLTAGE,        \
       .owner = THIS_MODULE,            \
   }
 
static const struct regulator_desc dio_regs_desc[DIO5632_MAX_REGULATORS] = {
   DIO5632_REGULATOR_DESC(VPOS, outp),
   DIO5632_REGULATOR_DESC(VNEG, outn),
};
 
static const struct regmap_range DIO5632_no_reg_ranges[] = {
   regmap_reg_range(DIO5632_REG_APPS_DISP_DISN + 1,
            DIO5632_REG_CONTROL - 1),
};
 
static const struct regmap_access_table DIO5632_no_reg_table = {
   .no_ranges = DIO5632_no_reg_ranges,
   .n_no_ranges = ARRAY_SIZE(DIO5632_no_reg_ranges),
};
 
static const struct regmap_config DIO5632_regmap_config = {
   .reg_bits    = 8,
   .val_bits    = 8,
   .max_register    = DIO5632_REG_CONTROL,
   .cache_type    = REGCACHE_NONE,
   .rd_table    = &DIO5632_no_reg_table,
   .wr_table    = &DIO5632_no_reg_table,
};
 
static int DIO5632_probe(struct i2c_client *client,
             const struct i2c_device_id *client_id)
{
   struct device *dev = &client->dev;
   struct DIO5632_regulator *dio;
   struct regulator_dev *rdev;
   struct regmap *rmap;
   struct regulator_config config = { };
   int id;
   int ret;
 
   dio = devm_kzalloc(dev, sizeof(*dio), GFP_KERNEL);
   if (!dio)
       return -ENOMEM;
 
   rmap = devm_regmap_init_i2c(client, &DIO5632_regmap_config);
   if (IS_ERR(rmap)) {
       ret = PTR_ERR(rmap);
       dev_err(dev, "regmap init failed: %d\n", ret);
       return ret;
   }
 
   i2c_set_clientdata(client, dio);
   dio->dev = dev;
 
   for (id = 0; id < DIO5632_MAX_REGULATORS; ++id) {
       config.regmap = rmap;
       config.dev = dev;
       config.driver_data = dio;
 
       rdev = devm_regulator_register(dev, &dio_regs_desc[id],
                          &config);
       if (IS_ERR(rdev)) {
           ret = PTR_ERR(rdev);
           dev_err(dev, "regulator %s register failed: %d\n",
               dio_regs_desc[id].name, ret);
           return ret;
       }
   }
   return 0;
}
 
static const struct i2c_device_id DIO5632_id[] = {
   {.name = "DIO5632",},
   {},
};
MODULE_DEVICE_TABLE(i2c, DIO5632_id);
 
static struct i2c_driver DIO5632_i2c_driver = {
   .driver = {
       .name = "DIO5632",
   },
   .probe = DIO5632_probe,
   .id_table = DIO5632_id,
};
 
module_i2c_driver(DIO5632_i2c_driver);
 
MODULE_DESCRIPTION("DIO5632 regulator driver");
MODULE_AUTHOR("Guochun Huang <hero.huang@rockchips.com>");
MODULE_LICENSE("GPL v2");