4 * Copyright (C) 2014 Texas Instruments Incorporated - http://www.ti.com/
5 * Author: Balaji T K <balajitk@ti.com>
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation version 2.
11 * This program is distributed "as is" WITHOUT ANY WARRANTY of any
12 * kind, whether express or implied; without even the implied warranty
13 * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
17 #include <linux/err.h>
19 #include <linux/module.h>
20 #include <linux/mfd/syscon.h>
21 #include <linux/platform_device.h>
22 #include <linux/regulator/driver.h>
23 #include <linux/regulator/machine.h>
24 #include <linux/regulator/of_regulator.h>
25 #include <linux/regmap.h>
26 #include <linux/slab.h>
28 #include <linux/of_device.h>
30 struct pbias_reg_info
{
34 unsigned int enable_time
;
38 struct pbias_regulator_data
{
39 struct regulator_desc desc
;
40 void __iomem
*pbias_addr
;
41 struct regulator_dev
*dev
;
42 struct regmap
*syscon
;
43 const struct pbias_reg_info
*info
;
47 static const unsigned int pbias_volt_table
[] = {
52 static int pbias_regulator_enable(struct regulator_dev
*rdev
)
54 struct pbias_regulator_data
*data
= rdev_get_drvdata(rdev
);
55 const struct pbias_reg_info
*info
= data
->info
;
57 return regmap_update_bits(data
->syscon
, rdev
->desc
->enable_reg
,
58 info
->enable_mask
, info
->enable
);
61 static int pbias_regulator_is_enable(struct regulator_dev
*rdev
)
63 struct pbias_regulator_data
*data
= rdev_get_drvdata(rdev
);
64 const struct pbias_reg_info
*info
= data
->info
;
67 regmap_read(data
->syscon
, rdev
->desc
->enable_reg
, &value
);
69 return (value
& info
->enable_mask
) == info
->enable
;
72 static struct regulator_ops pbias_regulator_voltage_ops
= {
73 .list_voltage
= regulator_list_voltage_table
,
74 .get_voltage_sel
= regulator_get_voltage_sel_regmap
,
75 .set_voltage_sel
= regulator_set_voltage_sel_regmap
,
76 .enable
= pbias_regulator_enable
,
77 .disable
= regulator_disable_regmap
,
78 .is_enabled
= pbias_regulator_is_enable
,
81 static const struct pbias_reg_info pbias_mmc_omap2430
= {
83 .enable_mask
= BIT(1),
86 .name
= "pbias_mmc_omap2430"
89 static const struct pbias_reg_info pbias_sim_omap3
= {
91 .enable_mask
= BIT(9),
94 .name
= "pbias_sim_omap3"
97 static const struct pbias_reg_info pbias_mmc_omap4
= {
98 .enable
= BIT(26) | BIT(22),
99 .enable_mask
= BIT(26) | BIT(25) | BIT(22),
102 .name
= "pbias_mmc_omap4"
105 static const struct pbias_reg_info pbias_mmc_omap5
= {
106 .enable
= BIT(27) | BIT(26),
107 .enable_mask
= BIT(27) | BIT(25) | BIT(26),
110 .name
= "pbias_mmc_omap5"
113 static struct of_regulator_match pbias_matches
[] = {
114 { .name
= "pbias_mmc_omap2430", .driver_data
= (void *)&pbias_mmc_omap2430
},
115 { .name
= "pbias_sim_omap3", .driver_data
= (void *)&pbias_sim_omap3
},
116 { .name
= "pbias_mmc_omap4", .driver_data
= (void *)&pbias_mmc_omap4
},
117 { .name
= "pbias_mmc_omap5", .driver_data
= (void *)&pbias_mmc_omap5
},
119 #define PBIAS_NUM_REGS ARRAY_SIZE(pbias_matches)
121 static const struct of_device_id pbias_of_match
[] = {
122 { .compatible
= "ti,pbias-omap", },
125 MODULE_DEVICE_TABLE(of
, pbias_of_match
);
127 static int pbias_regulator_probe(struct platform_device
*pdev
)
129 struct device_node
*np
= pdev
->dev
.of_node
;
130 struct pbias_regulator_data
*drvdata
;
131 struct resource
*res
;
132 struct regulator_config cfg
= { };
133 struct regmap
*syscon
;
134 const struct pbias_reg_info
*info
;
136 int count
, idx
, data_idx
= 0;
138 count
= of_regulator_match(&pdev
->dev
, np
, pbias_matches
,
143 drvdata
= devm_kzalloc(&pdev
->dev
, sizeof(struct pbias_regulator_data
)
144 * count
, GFP_KERNEL
);
145 if (drvdata
== NULL
) {
146 dev_err(&pdev
->dev
, "Failed to allocate device data\n");
150 syscon
= syscon_regmap_lookup_by_phandle(np
, "syscon");
152 return PTR_ERR(syscon
);
155 cfg
.dev
= &pdev
->dev
;
157 for (idx
= 0; idx
< PBIAS_NUM_REGS
&& data_idx
< count
; idx
++) {
158 if (!pbias_matches
[idx
].init_data
||
159 !pbias_matches
[idx
].of_node
)
162 info
= pbias_matches
[idx
].driver_data
;
166 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
170 drvdata
[data_idx
].syscon
= syscon
;
171 drvdata
[data_idx
].info
= info
;
172 drvdata
[data_idx
].desc
.name
= info
->name
;
173 drvdata
[data_idx
].desc
.owner
= THIS_MODULE
;
174 drvdata
[data_idx
].desc
.type
= REGULATOR_VOLTAGE
;
175 drvdata
[data_idx
].desc
.ops
= &pbias_regulator_voltage_ops
;
176 drvdata
[data_idx
].desc
.volt_table
= pbias_volt_table
;
177 drvdata
[data_idx
].desc
.n_voltages
= 2;
178 drvdata
[data_idx
].desc
.enable_time
= info
->enable_time
;
179 drvdata
[data_idx
].desc
.vsel_reg
= res
->start
;
180 drvdata
[data_idx
].desc
.vsel_mask
= info
->vmode
;
181 drvdata
[data_idx
].desc
.enable_reg
= res
->start
;
182 drvdata
[data_idx
].desc
.enable_mask
= info
->enable_mask
;
184 cfg
.init_data
= pbias_matches
[idx
].init_data
;
185 cfg
.driver_data
= &drvdata
[data_idx
];
186 cfg
.of_node
= pbias_matches
[idx
].of_node
;
188 drvdata
[data_idx
].dev
= devm_regulator_register(&pdev
->dev
,
189 &drvdata
[data_idx
].desc
, &cfg
);
190 if (IS_ERR(drvdata
[data_idx
].dev
)) {
191 ret
= PTR_ERR(drvdata
[data_idx
].dev
);
193 "Failed to register regulator: %d\n", ret
);
199 platform_set_drvdata(pdev
, drvdata
);
205 static struct platform_driver pbias_regulator_driver
= {
206 .probe
= pbias_regulator_probe
,
208 .name
= "pbias-regulator",
209 .owner
= THIS_MODULE
,
210 .of_match_table
= of_match_ptr(pbias_of_match
),
214 module_platform_driver(pbias_regulator_driver
);
216 MODULE_AUTHOR("Balaji T K <balajitk@ti.com>");
217 MODULE_DESCRIPTION("pbias voltage regulator");
218 MODULE_LICENSE("GPL");
219 MODULE_ALIAS("platform:pbias-regulator");