1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3  * (C) Copyright 2014 Hans de Goede <hdegoede@redhat.com>
4  *
5  * Based on allwinner u-boot sources rsb code which is:
6  * (C) Copyright 2007-2013
7  * Allwinner Technology Co., Ltd. <www.allwinnertech.com>
8  * lixiang <lixiang@allwinnertech.com>
9  */
10 
11 #include <axp_pmic.h>
12 #include <clk.h>
13 #include <dm.h>
14 #include <errno.h>
15 #include <i2c.h>
16 #include <sunxi_gpio.h>
17 #include <reset.h>
18 #include <time.h>
19 #include <asm/arch/cpu.h>
20 #include <asm/arch/prcm.h>
21 #include <asm/arch/rsb.h>
22 
sun8i_rsb_await_trans(struct sunxi_rsb_reg * base)23 static int sun8i_rsb_await_trans(struct sunxi_rsb_reg *base)
24 {
25 	unsigned long tmo = timer_get_us() + 1000000;
26 	u32 stat;
27 	int ret;
28 
29 	while (1) {
30 		stat = readl(&base->stat);
31 		if (stat & RSB_STAT_LBSY_INT) {
32 			ret = -EBUSY;
33 			break;
34 		}
35 		if (stat & RSB_STAT_TERR_INT) {
36 			ret = -EIO;
37 			break;
38 		}
39 		if (stat & RSB_STAT_TOVER_INT) {
40 			ret = 0;
41 			break;
42 		}
43 		if (timer_get_us() > tmo) {
44 			ret = -ETIME;
45 			break;
46 		}
47 	}
48 	writel(stat, &base->stat); /* Clear status bits */
49 
50 	return ret;
51 }
52 
sun8i_rsb_do_trans(struct sunxi_rsb_reg * base)53 static int sun8i_rsb_do_trans(struct sunxi_rsb_reg *base)
54 {
55 	setbits_le32(&base->ctrl, RSB_CTRL_START_TRANS);
56 
57 	return sun8i_rsb_await_trans(base);
58 }
59 
sun8i_rsb_read(struct sunxi_rsb_reg * base,u16 runtime_addr,u8 reg_addr,u8 * data)60 static int sun8i_rsb_read(struct sunxi_rsb_reg *base, u16 runtime_addr,
61 			  u8 reg_addr, u8 *data)
62 {
63 	int ret;
64 
65 	writel(RSB_DEVADDR_RUNTIME_ADDR(runtime_addr), &base->devaddr);
66 	writel(reg_addr, &base->addr);
67 	writel(RSB_CMD_BYTE_READ, &base->cmd);
68 
69 	ret = sun8i_rsb_do_trans(base);
70 	if (ret)
71 		return ret;
72 
73 	*data = readl(&base->data) & 0xff;
74 
75 	return 0;
76 }
77 
sun8i_rsb_write(struct sunxi_rsb_reg * base,u16 runtime_addr,u8 reg_addr,u8 data)78 static int sun8i_rsb_write(struct sunxi_rsb_reg *base, u16 runtime_addr,
79 			   u8 reg_addr, u8 data)
80 {
81 	writel(RSB_DEVADDR_RUNTIME_ADDR(runtime_addr), &base->devaddr);
82 	writel(reg_addr, &base->addr);
83 	writel(data, &base->data);
84 	writel(RSB_CMD_BYTE_WRITE, &base->cmd);
85 
86 	return sun8i_rsb_do_trans(base);
87 }
88 
sun8i_rsb_set_device_address(struct sunxi_rsb_reg * base,u16 device_addr,u16 runtime_addr)89 static int sun8i_rsb_set_device_address(struct sunxi_rsb_reg *base,
90 					u16 device_addr, u16 runtime_addr)
91 {
92 	writel(RSB_DEVADDR_RUNTIME_ADDR(runtime_addr) |
93 	       RSB_DEVADDR_DEVICE_ADDR(device_addr), &base->devaddr);
94 	writel(RSB_CMD_SET_RTSADDR, &base->cmd);
95 
96 	return sun8i_rsb_do_trans(base);
97 }
98 
sun8i_rsb_set_clk(struct sunxi_rsb_reg * base)99 static void sun8i_rsb_set_clk(struct sunxi_rsb_reg *base)
100 {
101 	u32 div = 0;
102 	u32 cd_odly = 0;
103 
104 	/* Source is Hosc24M, set RSB clk to 3Mhz */
105 	div = 24000000 / 3000000 / 2 - 1;
106 	cd_odly = div >> 1;
107 	if (!cd_odly)
108 		cd_odly = 1;
109 
110 	writel((cd_odly << 8) | div, &base->ccr);
111 }
112 
sun8i_rsb_set_device_mode(struct sunxi_rsb_reg * base)113 static int sun8i_rsb_set_device_mode(struct sunxi_rsb_reg *base)
114 {
115 	unsigned long tmo = timer_get_us() + 1000000;
116 
117 	writel(RSB_DMCR_DEVICE_MODE_START | RSB_DMCR_DEVICE_MODE_DATA,
118 	       &base->dmcr);
119 
120 	while (readl(&base->dmcr) & RSB_DMCR_DEVICE_MODE_START) {
121 		if (timer_get_us() > tmo)
122 			return -ETIME;
123 	}
124 
125 	return sun8i_rsb_await_trans(base);
126 }
127 
sun8i_rsb_init(struct sunxi_rsb_reg * base)128 static int sun8i_rsb_init(struct sunxi_rsb_reg *base)
129 {
130 	writel(RSB_CTRL_SOFT_RST, &base->ctrl);
131 	sun8i_rsb_set_clk(base);
132 
133 	return sun8i_rsb_set_device_mode(base);
134 }
135 
136 #if IS_ENABLED(CONFIG_AXP_PMIC_BUS)
rsb_read(const u16 runtime_addr,const u8 reg_addr,u8 * data)137 int rsb_read(const u16 runtime_addr, const u8 reg_addr, u8 *data)
138 {
139 	struct sunxi_rsb_reg *base = (struct sunxi_rsb_reg *)SUNXI_RSB_BASE;
140 
141 	return sun8i_rsb_read(base, runtime_addr, reg_addr, data);
142 }
143 
rsb_write(const u16 runtime_addr,const u8 reg_addr,u8 data)144 int rsb_write(const u16 runtime_addr, const u8 reg_addr, u8 data)
145 {
146 	struct sunxi_rsb_reg *base = (struct sunxi_rsb_reg *)SUNXI_RSB_BASE;
147 
148 	return sun8i_rsb_write(base, runtime_addr, reg_addr, data);
149 }
150 
rsb_set_device_address(u16 device_addr,u16 runtime_addr)151 int rsb_set_device_address(u16 device_addr, u16 runtime_addr)
152 {
153 	struct sunxi_rsb_reg *base = (struct sunxi_rsb_reg *)SUNXI_RSB_BASE;
154 
155 	return sun8i_rsb_set_device_address(base, device_addr, runtime_addr);
156 }
157 
rsb_init(void)158 int rsb_init(void)
159 {
160 	struct sunxi_rsb_reg *base = (struct sunxi_rsb_reg *)SUNXI_RSB_BASE;
161 
162 	/* Enable RSB and PIO clk, and de-assert their resets */
163 	prcm_apb0_enable(PRCM_APB0_GATE_PIO | PRCM_APB0_GATE_RSB);
164 
165 	if (IS_ENABLED(CONFIG_MACH_SUN9I)) {
166 		sunxi_gpio_set_cfgpin(SUNXI_GPN(0), SUN9I_GPN_R_RSB);
167 		sunxi_gpio_set_cfgpin(SUNXI_GPN(1), SUN9I_GPN_R_RSB);
168 		sunxi_gpio_set_pull(SUNXI_GPN(0), 1);
169 		sunxi_gpio_set_pull(SUNXI_GPN(1), 1);
170 		sunxi_gpio_set_drv(SUNXI_GPN(0), 2);
171 		sunxi_gpio_set_drv(SUNXI_GPN(1), 2);
172 	} else {
173 		sunxi_gpio_set_cfgpin(SUNXI_GPL(0), SUN8I_GPL_R_RSB);
174 		sunxi_gpio_set_cfgpin(SUNXI_GPL(1), SUN8I_GPL_R_RSB);
175 		sunxi_gpio_set_pull(SUNXI_GPL(0), 1);
176 		sunxi_gpio_set_pull(SUNXI_GPL(1), 1);
177 		sunxi_gpio_set_drv(SUNXI_GPL(0), 2);
178 		sunxi_gpio_set_drv(SUNXI_GPL(1), 2);
179 	}
180 
181 	return sun8i_rsb_init(base);
182 }
183 #endif
184 
185 #if CONFIG_IS_ENABLED(DM_I2C)
186 struct sun8i_rsb_priv {
187 	struct sunxi_rsb_reg *base;
188 };
189 
190 /*
191  * The mapping from hardware address to runtime address is fixed, and shared
192  * among all RSB drivers. See the comment in drivers/bus/sunxi-rsb.c in Linux.
193  */
sun8i_rsb_get_runtime_address(u16 device_addr)194 static int sun8i_rsb_get_runtime_address(u16 device_addr)
195 {
196 	if (device_addr == AXP_PMIC_PRI_DEVICE_ADDR)
197 		return AXP_PMIC_PRI_RUNTIME_ADDR;
198 	if (device_addr == AXP_PMIC_SEC_DEVICE_ADDR)
199 		return AXP_PMIC_SEC_RUNTIME_ADDR;
200 
201 	return -ENXIO;
202 }
203 
sun8i_rsb_xfer(struct udevice * bus,struct i2c_msg * msg,int nmsgs)204 static int sun8i_rsb_xfer(struct udevice *bus, struct i2c_msg *msg, int nmsgs)
205 {
206 	int runtime_addr = sun8i_rsb_get_runtime_address(msg->addr);
207 	struct sun8i_rsb_priv *priv = dev_get_priv(bus);
208 
209 	if (runtime_addr < 0)
210 		return runtime_addr;
211 
212 	/* The hardware only supports SMBus-style transfers. */
213 	if (nmsgs == 2 && msg[1].flags == I2C_M_RD && msg[1].len == 1)
214 		return sun8i_rsb_read(priv->base, runtime_addr,
215 				      msg[0].buf[0], &msg[1].buf[0]);
216 
217 	if (nmsgs == 1 && msg[0].len == 2)
218 		return sun8i_rsb_write(priv->base, runtime_addr,
219 				       msg[0].buf[0], msg[0].buf[1]);
220 
221 	return -EINVAL;
222 }
223 
sun8i_rsb_probe_chip(struct udevice * bus,uint chip_addr,uint chip_flags)224 static int sun8i_rsb_probe_chip(struct udevice *bus, uint chip_addr,
225 				uint chip_flags)
226 {
227 	int runtime_addr = sun8i_rsb_get_runtime_address(chip_addr);
228 	struct sun8i_rsb_priv *priv = dev_get_priv(bus);
229 
230 	if (runtime_addr < 0)
231 		return runtime_addr;
232 
233 	return sun8i_rsb_set_device_address(priv->base, chip_addr, runtime_addr);
234 }
235 
sun8i_rsb_probe(struct udevice * bus)236 static int sun8i_rsb_probe(struct udevice *bus)
237 {
238 	struct sun8i_rsb_priv *priv = dev_get_priv(bus);
239 	struct reset_ctl *reset;
240 	struct clk *clk;
241 
242 	priv->base = dev_read_addr_ptr(bus);
243 
244 	reset = devm_reset_control_get(bus, NULL);
245 	if (!IS_ERR(reset))
246 		reset_deassert(reset);
247 
248 	clk = devm_clk_get(bus, NULL);
249 	if (!IS_ERR(clk))
250 		clk_enable(clk);
251 
252 	return sun8i_rsb_init(priv->base);
253 }
254 
sun8i_rsb_child_pre_probe(struct udevice * child)255 static int sun8i_rsb_child_pre_probe(struct udevice *child)
256 {
257 	struct dm_i2c_chip *chip = dev_get_parent_plat(child);
258 	struct udevice *bus = child->parent;
259 
260 	/* Ensure each transfer is for a single register. */
261 	chip->flags |= DM_I2C_CHIP_RD_ADDRESS | DM_I2C_CHIP_WR_ADDRESS;
262 
263 	return sun8i_rsb_probe_chip(bus, chip->chip_addr, 0);
264 }
265 
266 static const struct dm_i2c_ops sun8i_rsb_ops = {
267 	.xfer		= sun8i_rsb_xfer,
268 	.probe_chip	= sun8i_rsb_probe_chip,
269 };
270 
271 static const struct udevice_id sun8i_rsb_ids[] = {
272 	{ .compatible = "allwinner,sun8i-a23-rsb" },
273 	{ /* sentinel */ }
274 };
275 
276 U_BOOT_DRIVER(sun8i_rsb) = {
277 	.name			= "sun8i_rsb",
278 	.id			= UCLASS_I2C,
279 	.of_match		= sun8i_rsb_ids,
280 	.probe			= sun8i_rsb_probe,
281 	.child_pre_probe	= sun8i_rsb_child_pre_probe,
282 	.priv_auto		= sizeof(struct sun8i_rsb_priv),
283 	.ops			= &sun8i_rsb_ops,
284 };
285 #endif /* CONFIG_IS_ENABLED(DM_I2C) */
286