1 // SPDX-License-Identifier: GPL-2.0+
3 #include <linux/delay.h>
4 #include <linux/gpio/consumer.h>
6 #include <linux/interrupt.h>
7 #include <linux/kernel.h>
8 #include <linux/module.h>
9 #include <linux/property.h>
10 #include <linux/regmap.h>
11 #include <linux/regulator/driver.h>
13 #define RTMV20_REG_DEVINFO 0x00
14 #define RTMV20_REG_PULSEDELAY 0x01
15 #define RTMV20_REG_PULSEWIDTH 0x03
16 #define RTMV20_REG_LDCTRL1 0x05
17 #define RTMV20_REG_ESPULSEWIDTH 0x06
18 #define RTMV20_REG_ESLDCTRL1 0x08
19 #define RTMV20_REG_LBP 0x0A
20 #define RTMV20_REG_LDCTRL2 0x0B
21 #define RTMV20_REG_FSIN1CTRL1 0x0D
22 #define RTMV20_REG_FSIN1CTRL3 0x0F
23 #define RTMV20_REG_FSIN2CTRL1 0x10
24 #define RTMV20_REG_FSIN2CTRL3 0x12
25 #define RTMV20_REG_ENCTRL 0x13
26 #define RTMV20_REG_STRBVSYNDLYL 0x29
27 #define RTMV20_REG_LDIRQ 0x30
28 #define RTMV20_REG_LDSTAT 0x40
29 #define RTMV20_REG_LDMASK 0x50
31 #define RTMV20_VID_MASK GENMASK(7, 4)
32 #define RICHTEK_VID 0x80
33 #define RTMV20_LDCURR_MASK GENMASK(7, 0)
34 #define RTMV20_DELAY_MASK GENMASK(9, 0)
35 #define RTMV20_WIDTH_MASK GENMASK(13, 0)
36 #define RTMV20_WIDTH2_MASK GENMASK(7, 0)
37 #define RTMV20_LBPLVL_MASK GENMASK(3, 0)
38 #define RTMV20_LBPEN_MASK BIT(7)
39 #define RTMV20_STROBEPOL_MASK BIT(1)
40 #define RTMV20_VSYNPOL_MASK BIT(1)
41 #define RTMV20_FSINEN_MASK BIT(7)
42 #define RTMV20_ESEN_MASK BIT(6)
43 #define RTMV20_FSINOUT_MASK BIT(2)
44 #define LDENABLE_MASK (BIT(3) | BIT(0))
46 #define OTPEVT_MASK BIT(4)
47 #define SHORTEVT_MASK BIT(3)
48 #define OPENEVT_MASK BIT(2)
49 #define LBPEVT_MASK BIT(1)
50 #define OCPEVT_MASK BIT(0)
51 #define FAILEVT_MASK (SHORTEVT_MASK | OPENEVT_MASK | LBPEVT_MASK)
53 #define RTMV20_LSW_MINUA 0
54 #define RTMV20_LSW_MAXUA 6000000
55 #define RTMV20_LSW_STEPUA 30000
57 #define RTMV20_LSW_DEFAULTUA 3000000
59 #define RTMV20_I2CRDY_TIMEUS 200
60 #define RTMV20_CSRDY_TIMEUS 2000
64 struct regmap
*regmap
;
65 struct gpio_desc
*enable_gpio
;
66 struct regulator_dev
*rdev
;
69 static int rtmv20_lsw_enable(struct regulator_dev
*rdev
)
71 struct rtmv20_priv
*priv
= rdev_get_drvdata(rdev
);
74 gpiod_set_value(priv
->enable_gpio
, 1);
76 /* Wait for I2C can be accessed */
77 usleep_range(RTMV20_I2CRDY_TIMEUS
, RTMV20_I2CRDY_TIMEUS
+ 100);
79 /* HW re-enable, disable cache only and sync regcache here */
80 regcache_cache_only(priv
->regmap
, false);
81 ret
= regcache_sync(priv
->regmap
);
85 return regulator_enable_regmap(rdev
);
88 static int rtmv20_lsw_disable(struct regulator_dev
*rdev
)
90 struct rtmv20_priv
*priv
= rdev_get_drvdata(rdev
);
93 ret
= regulator_disable_regmap(rdev
);
97 /* Mark the regcache as dirty and cache only before HW disabled */
98 regcache_cache_only(priv
->regmap
, true);
99 regcache_mark_dirty(priv
->regmap
);
101 gpiod_set_value(priv
->enable_gpio
, 0);
106 static const struct regulator_ops rtmv20_regulator_ops
= {
107 .set_current_limit
= regulator_set_current_limit_regmap
,
108 .get_current_limit
= regulator_get_current_limit_regmap
,
109 .enable
= rtmv20_lsw_enable
,
110 .disable
= rtmv20_lsw_disable
,
111 .is_enabled
= regulator_is_enabled_regmap
,
114 static const struct regulator_desc rtmv20_lsw_desc
= {
115 .name
= "rtmv20,lsw",
116 .of_match
= of_match_ptr("lsw"),
117 .type
= REGULATOR_CURRENT
,
118 .owner
= THIS_MODULE
,
119 .ops
= &rtmv20_regulator_ops
,
120 .csel_reg
= RTMV20_REG_LDCTRL1
,
121 .csel_mask
= RTMV20_LDCURR_MASK
,
122 .enable_reg
= RTMV20_REG_ENCTRL
,
123 .enable_mask
= LDENABLE_MASK
,
124 .enable_time
= RTMV20_CSRDY_TIMEUS
,
127 static irqreturn_t
rtmv20_irq_handler(int irq
, void *data
)
129 struct rtmv20_priv
*priv
= data
;
133 ret
= regmap_read(priv
->regmap
, RTMV20_REG_LDIRQ
, &val
);
135 dev_err(priv
->dev
, "Failed to get irq flags\n");
139 if (val
& OTPEVT_MASK
)
140 regulator_notifier_call_chain(priv
->rdev
, REGULATOR_EVENT_OVER_TEMP
, NULL
);
142 if (val
& OCPEVT_MASK
)
143 regulator_notifier_call_chain(priv
->rdev
, REGULATOR_EVENT_OVER_CURRENT
, NULL
);
145 if (val
& FAILEVT_MASK
)
146 regulator_notifier_call_chain(priv
->rdev
, REGULATOR_EVENT_FAIL
, NULL
);
151 static u32
clamp_to_selector(u32 val
, u32 min
, u32 max
, u32 step
)
153 u32 retval
= clamp_val(val
, min
, max
);
155 return (retval
- min
) / step
;
158 static int rtmv20_properties_init(struct rtmv20_priv
*priv
)
169 { "richtek,ld-pulse-delay-us", 0, 0, 100000, 100, RTMV20_REG_PULSEDELAY
,
171 { "richtek,ld-pulse-width-us", 1200, 0, 10000, 1, RTMV20_REG_PULSEWIDTH
,
173 { "richtek,fsin1-delay-us", 23000, 0, 100000, 100, RTMV20_REG_FSIN1CTRL1
,
175 { "richtek,fsin1-width-us", 160, 40, 10000, 40, RTMV20_REG_FSIN1CTRL3
,
176 RTMV20_WIDTH2_MASK
},
177 { "richtek,fsin2-delay-us", 23000, 0, 100000, 100, RTMV20_REG_FSIN2CTRL1
,
179 { "richtek,fsin2-width-us", 160, 40, 10000, 40, RTMV20_REG_FSIN2CTRL3
,
180 RTMV20_WIDTH2_MASK
},
181 { "richtek,es-pulse-width-us", 1200, 0, 10000, 1, RTMV20_REG_ESPULSEWIDTH
,
183 { "richtek,es-ld-current-microamp", 3000000, 0, 6000000, 30000,
184 RTMV20_REG_ESLDCTRL1
, RTMV20_LDCURR_MASK
},
185 { "richtek,lbp-level-microvolt", 2700000, 2400000, 3700000, 100000, RTMV20_REG_LBP
,
186 RTMV20_LBPLVL_MASK
},
187 { "richtek,lbp-enable", 0, 0, 1, 1, RTMV20_REG_LBP
, RTMV20_LBPEN_MASK
},
188 { "richtek,strobe-polarity-high", 1, 0, 1, 1, RTMV20_REG_LDCTRL2
,
189 RTMV20_STROBEPOL_MASK
},
190 { "richtek,vsync-polarity-high", 1, 0, 1, 1, RTMV20_REG_LDCTRL2
,
191 RTMV20_VSYNPOL_MASK
},
192 { "richtek,fsin-enable", 0, 0, 1, 1, RTMV20_REG_ENCTRL
, RTMV20_FSINEN_MASK
},
193 { "richtek,fsin-output", 0, 0, 1, 1, RTMV20_REG_ENCTRL
, RTMV20_FSINOUT_MASK
},
194 { "richtek,es-enable", 0, 0, 1, 1, RTMV20_REG_ENCTRL
, RTMV20_ESEN_MASK
},
198 for (i
= 0; i
< ARRAY_SIZE(props
); i
++) {
202 int significant_bit
= fls(props
[i
].mask
);
203 int shift
= ffs(props
[i
].mask
) - 1;
205 if (props
[i
].max
> 1) {
206 ret
= device_property_read_u32(priv
->dev
, props
[i
].name
, &temp
);
210 temp
= device_property_read_bool(priv
->dev
, props
[i
].name
);
212 temp
= clamp_to_selector(temp
, props
[i
].min
, props
[i
].max
, props
[i
].step
);
214 /* If significant bit is over 8, two byte access, others one */
215 if (significant_bit
> 8) {
216 ret
= regmap_raw_read(priv
->regmap
, props
[i
].addr
, &bval16
, sizeof(bval16
));
220 val16
= be16_to_cpu(bval16
);
221 val16
&= ~props
[i
].mask
;
222 val16
|= (temp
<< shift
);
223 bval16
= cpu_to_be16(val16
);
225 ret
= regmap_raw_write(priv
->regmap
, props
[i
].addr
, &bval16
,
228 ret
= regmap_update_bits(priv
->regmap
, props
[i
].addr
, props
[i
].mask
,
239 static int rtmv20_check_chip_exist(struct rtmv20_priv
*priv
)
244 ret
= regmap_read(priv
->regmap
, RTMV20_REG_DEVINFO
, &val
);
248 if ((val
& RTMV20_VID_MASK
) != RICHTEK_VID
)
254 static bool rtmv20_is_accessible_reg(struct device
*dev
, unsigned int reg
)
257 case RTMV20_REG_DEVINFO
... RTMV20_REG_STRBVSYNDLYL
:
258 case RTMV20_REG_LDIRQ
:
259 case RTMV20_REG_LDSTAT
:
260 case RTMV20_REG_LDMASK
:
266 static bool rtmv20_is_volatile_reg(struct device
*dev
, unsigned int reg
)
268 if (reg
== RTMV20_REG_LDIRQ
|| reg
== RTMV20_REG_LDSTAT
)
273 static const struct regmap_config rtmv20_regmap_config
= {
276 .cache_type
= REGCACHE_RBTREE
,
277 .max_register
= RTMV20_REG_LDMASK
,
279 .writeable_reg
= rtmv20_is_accessible_reg
,
280 .readable_reg
= rtmv20_is_accessible_reg
,
281 .volatile_reg
= rtmv20_is_volatile_reg
,
284 static int rtmv20_probe(struct i2c_client
*i2c
)
286 struct rtmv20_priv
*priv
;
287 struct regulator_config config
= {};
290 priv
= devm_kzalloc(&i2c
->dev
, sizeof(*priv
), GFP_KERNEL
);
294 priv
->dev
= &i2c
->dev
;
296 /* Before regmap register, configure HW enable to make I2C accessible */
297 priv
->enable_gpio
= devm_gpiod_get(&i2c
->dev
, "enable", GPIOD_OUT_HIGH
);
298 if (IS_ERR(priv
->enable_gpio
)) {
299 dev_err(&i2c
->dev
, "Failed to get enable gpio\n");
300 return PTR_ERR(priv
->enable_gpio
);
303 /* Wait for I2C can be accessed */
304 usleep_range(RTMV20_I2CRDY_TIMEUS
, RTMV20_I2CRDY_TIMEUS
+ 100);
306 priv
->regmap
= devm_regmap_init_i2c(i2c
, &rtmv20_regmap_config
);
307 if (IS_ERR(priv
->regmap
)) {
308 dev_err(&i2c
->dev
, "Failed to allocate register map\n");
309 return PTR_ERR(priv
->regmap
);
312 ret
= rtmv20_check_chip_exist(priv
);
314 dev_err(&i2c
->dev
, "Chip vendor info is not matched\n");
318 ret
= rtmv20_properties_init(priv
);
320 dev_err(&i2c
->dev
, "Failed to init properties\n");
325 * keep in shutdown mode to minimize the current consumption
326 * and also mark regcache as dirty
328 regcache_cache_only(priv
->regmap
, true);
329 regcache_mark_dirty(priv
->regmap
);
330 gpiod_set_value(priv
->enable_gpio
, 0);
332 config
.dev
= &i2c
->dev
;
333 config
.regmap
= priv
->regmap
;
334 config
.driver_data
= priv
;
335 priv
->rdev
= devm_regulator_register(&i2c
->dev
, &rtmv20_lsw_desc
, &config
);
336 if (IS_ERR(priv
->rdev
)) {
337 dev_err(&i2c
->dev
, "Failed to register regulator\n");
338 return PTR_ERR(priv
->rdev
);
341 /* Unmask all events before IRQ registered */
342 ret
= regmap_write(priv
->regmap
, RTMV20_REG_LDMASK
, 0);
346 return devm_request_threaded_irq(&i2c
->dev
, i2c
->irq
, NULL
, rtmv20_irq_handler
,
347 IRQF_ONESHOT
, dev_name(&i2c
->dev
), priv
);
350 static int __maybe_unused
rtmv20_suspend(struct device
*dev
)
352 struct i2c_client
*i2c
= to_i2c_client(dev
);
355 * When system suspend, disable irq to prevent interrupt trigger
356 * during I2C bus suspend
358 disable_irq(i2c
->irq
);
359 if (device_may_wakeup(dev
))
360 enable_irq_wake(i2c
->irq
);
365 static int __maybe_unused
rtmv20_resume(struct device
*dev
)
367 struct i2c_client
*i2c
= to_i2c_client(dev
);
369 /* Enable irq after I2C bus already resume */
370 enable_irq(i2c
->irq
);
371 if (device_may_wakeup(dev
))
372 disable_irq_wake(i2c
->irq
);
377 static SIMPLE_DEV_PM_OPS(rtmv20_pm
, rtmv20_suspend
, rtmv20_resume
);
379 static const struct of_device_id __maybe_unused rtmv20_of_id
[] = {
380 { .compatible
= "richtek,rtmv20", },
383 MODULE_DEVICE_TABLE(of
, rtmv20_of_id
);
385 static struct i2c_driver rtmv20_driver
= {
388 .of_match_table
= of_match_ptr(rtmv20_of_id
),
391 .probe_new
= rtmv20_probe
,
393 module_i2c_driver(rtmv20_driver
);
395 MODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek.com>");
396 MODULE_DESCRIPTION("Richtek RTMV20 Regulator Driver");
397 MODULE_LICENSE("GPL v2");