134374699SSimon Glass /* 234374699SSimon Glass * (C) Copyright 2015 Google, Inc 334374699SSimon Glass * 434374699SSimon Glass * (C) Copyright 2008-2014 Rockchip Electronics 534374699SSimon Glass * Peter, Software Engineering, <superpeter.cai@gmail.com>. 634374699SSimon Glass * 734374699SSimon Glass * SPDX-License-Identifier: GPL-2.0+ 834374699SSimon Glass */ 934374699SSimon Glass 1034374699SSimon Glass #include <common.h> 1134374699SSimon Glass #include <clk.h> 1234374699SSimon Glass #include <dm.h> 1334374699SSimon Glass #include <errno.h> 1434374699SSimon Glass #include <i2c.h> 1534374699SSimon Glass #include <asm/io.h> 1634374699SSimon Glass #include <asm/arch/clock.h> 1734374699SSimon Glass #include <asm/arch/i2c.h> 1834374699SSimon Glass #include <asm/arch/periph.h> 1934374699SSimon Glass #include <dm/pinctrl.h> 2034374699SSimon Glass #include <linux/sizes.h> 2134374699SSimon Glass 2234374699SSimon Glass DECLARE_GLOBAL_DATA_PTR; 2334374699SSimon Glass 2434374699SSimon Glass /* i2c timerout */ 2534374699SSimon Glass #define I2C_TIMEOUT_MS 100 2634374699SSimon Glass #define I2C_RETRY_COUNT 3 2734374699SSimon Glass 2834374699SSimon Glass /* rk i2c fifo max transfer bytes */ 2934374699SSimon Glass #define RK_I2C_FIFO_SIZE 32 3034374699SSimon Glass 3134374699SSimon Glass struct rk_i2c { 3234374699SSimon Glass struct udevice *clk; 3334374699SSimon Glass struct i2c_regs *regs; 3434374699SSimon Glass unsigned int speed; 35*930bc374SSimon Glass int clk_id; 3634374699SSimon Glass }; 3734374699SSimon Glass 3834374699SSimon Glass static inline void rk_i2c_get_div(int div, int *divh, int *divl) 3934374699SSimon Glass { 4034374699SSimon Glass *divl = div / 2; 4134374699SSimon Glass if (div % 2 == 0) 4234374699SSimon Glass *divh = div / 2; 4334374699SSimon Glass else 4434374699SSimon Glass *divh = DIV_ROUND_UP(div, 2); 4534374699SSimon Glass } 4634374699SSimon Glass 4734374699SSimon Glass /* 4834374699SSimon Glass * SCL Divisor = 8 * (CLKDIVL+1 + CLKDIVH+1) 4934374699SSimon Glass * SCL = PCLK / SCLK Divisor 5034374699SSimon Glass * i2c_rate = PCLK 5134374699SSimon Glass */ 5234374699SSimon Glass static void rk_i2c_set_clk(struct rk_i2c *i2c, uint32_t scl_rate) 5334374699SSimon Glass { 5434374699SSimon Glass uint32_t i2c_rate; 5534374699SSimon Glass int div, divl, divh; 5634374699SSimon Glass 5734374699SSimon Glass /* First get i2c rate from pclk */ 58*930bc374SSimon Glass i2c_rate = clk_get_periph_rate(i2c->clk, i2c->clk_id); 5934374699SSimon Glass 6034374699SSimon Glass div = DIV_ROUND_UP(i2c_rate, scl_rate * 8) - 2; 6134374699SSimon Glass divh = 0; 6234374699SSimon Glass divl = 0; 6334374699SSimon Glass if (div >= 0) 6434374699SSimon Glass rk_i2c_get_div(div, &divh, &divl); 6534374699SSimon Glass writel(I2C_CLKDIV_VAL(divl, divh), &i2c->regs->clkdiv); 6634374699SSimon Glass 6734374699SSimon Glass debug("rk_i2c_set_clk: i2c rate = %d, scl rate = %d\n", i2c_rate, 6834374699SSimon Glass scl_rate); 6934374699SSimon Glass debug("set i2c clk div = %d, divh = %d, divl = %d\n", div, divh, divl); 7034374699SSimon Glass debug("set clk(I2C_CLKDIV: 0x%08x)\n", readl(&i2c->regs->clkdiv)); 7134374699SSimon Glass } 7234374699SSimon Glass 7334374699SSimon Glass static void rk_i2c_show_regs(struct i2c_regs *regs) 7434374699SSimon Glass { 7534374699SSimon Glass #ifdef DEBUG 7634374699SSimon Glass uint i; 7734374699SSimon Glass 7834374699SSimon Glass debug("i2c_con: 0x%08x\n", readl(®s->con)); 7934374699SSimon Glass debug("i2c_clkdiv: 0x%08x\n", readl(®s->clkdiv)); 8034374699SSimon Glass debug("i2c_mrxaddr: 0x%08x\n", readl(®s->mrxaddr)); 8134374699SSimon Glass debug("i2c_mrxraddR: 0x%08x\n", readl(®s->mrxraddr)); 8234374699SSimon Glass debug("i2c_mtxcnt: 0x%08x\n", readl(®s->mtxcnt)); 8334374699SSimon Glass debug("i2c_mrxcnt: 0x%08x\n", readl(®s->mrxcnt)); 8434374699SSimon Glass debug("i2c_ien: 0x%08x\n", readl(®s->ien)); 8534374699SSimon Glass debug("i2c_ipd: 0x%08x\n", readl(®s->ipd)); 8634374699SSimon Glass debug("i2c_fcnt: 0x%08x\n", readl(®s->fcnt)); 8734374699SSimon Glass for (i = 0; i < 8; i++) 8834374699SSimon Glass debug("i2c_txdata%d: 0x%08x\n", i, readl(®s->txdata[i])); 8934374699SSimon Glass for (i = 0; i < 8; i++) 9034374699SSimon Glass debug("i2c_rxdata%d: 0x%08x\n", i, readl(®s->rxdata[i])); 9134374699SSimon Glass #endif 9234374699SSimon Glass } 9334374699SSimon Glass 9434374699SSimon Glass static int rk_i2c_send_start_bit(struct rk_i2c *i2c) 9534374699SSimon Glass { 9634374699SSimon Glass struct i2c_regs *regs = i2c->regs; 9734374699SSimon Glass ulong start; 9834374699SSimon Glass 9934374699SSimon Glass debug("I2c Send Start bit.\n"); 10034374699SSimon Glass writel(I2C_IPD_ALL_CLEAN, ®s->ipd); 10134374699SSimon Glass 10234374699SSimon Glass writel(I2C_CON_EN | I2C_CON_START, ®s->con); 10334374699SSimon Glass writel(I2C_STARTIEN, ®s->ien); 10434374699SSimon Glass 10534374699SSimon Glass start = get_timer(0); 10634374699SSimon Glass while (1) { 10734374699SSimon Glass if (readl(®s->ipd) & I2C_STARTIPD) { 10834374699SSimon Glass writel(I2C_STARTIPD, ®s->ipd); 10934374699SSimon Glass break; 11034374699SSimon Glass } 11134374699SSimon Glass if (get_timer(start) > I2C_TIMEOUT_MS) { 11234374699SSimon Glass debug("I2C Send Start Bit Timeout\n"); 11334374699SSimon Glass rk_i2c_show_regs(regs); 11434374699SSimon Glass return -ETIMEDOUT; 11534374699SSimon Glass } 11634374699SSimon Glass udelay(1); 11734374699SSimon Glass } 11834374699SSimon Glass 11934374699SSimon Glass return 0; 12034374699SSimon Glass } 12134374699SSimon Glass 12234374699SSimon Glass static int rk_i2c_send_stop_bit(struct rk_i2c *i2c) 12334374699SSimon Glass { 12434374699SSimon Glass struct i2c_regs *regs = i2c->regs; 12534374699SSimon Glass ulong start; 12634374699SSimon Glass 12734374699SSimon Glass debug("I2c Send Stop bit.\n"); 12834374699SSimon Glass writel(I2C_IPD_ALL_CLEAN, ®s->ipd); 12934374699SSimon Glass 13034374699SSimon Glass writel(I2C_CON_EN | I2C_CON_STOP, ®s->con); 13134374699SSimon Glass writel(I2C_CON_STOP, ®s->ien); 13234374699SSimon Glass 13334374699SSimon Glass start = get_timer(0); 13434374699SSimon Glass while (1) { 13534374699SSimon Glass if (readl(®s->ipd) & I2C_STOPIPD) { 13634374699SSimon Glass writel(I2C_STOPIPD, ®s->ipd); 13734374699SSimon Glass break; 13834374699SSimon Glass } 13934374699SSimon Glass if (get_timer(start) > I2C_TIMEOUT_MS) { 14034374699SSimon Glass debug("I2C Send Start Bit Timeout\n"); 14134374699SSimon Glass rk_i2c_show_regs(regs); 14234374699SSimon Glass return -ETIMEDOUT; 14334374699SSimon Glass } 14434374699SSimon Glass udelay(1); 14534374699SSimon Glass } 14634374699SSimon Glass 14734374699SSimon Glass return 0; 14834374699SSimon Glass } 14934374699SSimon Glass 15034374699SSimon Glass static inline void rk_i2c_disable(struct rk_i2c *i2c) 15134374699SSimon Glass { 15234374699SSimon Glass writel(0, &i2c->regs->con); 15334374699SSimon Glass } 15434374699SSimon Glass 15534374699SSimon Glass static int rk_i2c_read(struct rk_i2c *i2c, uchar chip, uint reg, uint r_len, 15634374699SSimon Glass uchar *buf, uint b_len) 15734374699SSimon Glass { 15834374699SSimon Glass struct i2c_regs *regs = i2c->regs; 15934374699SSimon Glass uchar *pbuf = buf; 16034374699SSimon Glass uint bytes_remain_len = b_len; 16134374699SSimon Glass uint bytes_xferred = 0; 16234374699SSimon Glass uint words_xferred = 0; 16334374699SSimon Glass ulong start; 16434374699SSimon Glass uint con = 0; 16534374699SSimon Glass uint rxdata; 16634374699SSimon Glass uint i, j; 16734374699SSimon Glass int err; 16834374699SSimon Glass 16934374699SSimon Glass debug("rk_i2c_read: chip = %d, reg = %d, r_len = %d, b_len = %d\n", 17034374699SSimon Glass chip, reg, r_len, b_len); 17134374699SSimon Glass 17234374699SSimon Glass err = rk_i2c_send_start_bit(i2c); 17334374699SSimon Glass if (err) 17434374699SSimon Glass return err; 17534374699SSimon Glass 17634374699SSimon Glass writel(I2C_MRXADDR_SET(1, chip << 1 | 1), ®s->mrxaddr); 17734374699SSimon Glass if (r_len == 0) { 17834374699SSimon Glass writel(0, ®s->mrxraddr); 17934374699SSimon Glass } else if (r_len < 4) { 18034374699SSimon Glass writel(I2C_MRXRADDR_SET(r_len, reg), ®s->mrxraddr); 18134374699SSimon Glass } else { 18234374699SSimon Glass debug("I2C Read: addr len %d not supported\n", r_len); 18334374699SSimon Glass return -EIO; 18434374699SSimon Glass } 18534374699SSimon Glass 18634374699SSimon Glass while (bytes_remain_len) { 18734374699SSimon Glass if (bytes_remain_len > RK_I2C_FIFO_SIZE) { 18834374699SSimon Glass con = I2C_CON_EN | I2C_CON_MOD(I2C_MODE_TRX); 18934374699SSimon Glass bytes_xferred = 32; 19034374699SSimon Glass } else { 19134374699SSimon Glass con = I2C_CON_EN | I2C_CON_MOD(I2C_MODE_TRX) | 19234374699SSimon Glass I2C_CON_LASTACK; 19334374699SSimon Glass bytes_xferred = bytes_remain_len; 19434374699SSimon Glass } 19534374699SSimon Glass words_xferred = DIV_ROUND_UP(bytes_xferred, 4); 19634374699SSimon Glass 19734374699SSimon Glass writel(con, ®s->con); 19834374699SSimon Glass writel(bytes_xferred, ®s->mrxcnt); 19934374699SSimon Glass writel(I2C_MBRFIEN | I2C_NAKRCVIEN, ®s->ien); 20034374699SSimon Glass 20134374699SSimon Glass start = get_timer(0); 20234374699SSimon Glass while (1) { 20334374699SSimon Glass if (readl(®s->ipd) & I2C_NAKRCVIPD) { 20434374699SSimon Glass writel(I2C_NAKRCVIPD, ®s->ipd); 20534374699SSimon Glass err = -EREMOTEIO; 20634374699SSimon Glass } 20734374699SSimon Glass if (readl(®s->ipd) & I2C_MBRFIPD) { 20834374699SSimon Glass writel(I2C_MBRFIPD, ®s->ipd); 20934374699SSimon Glass break; 21034374699SSimon Glass } 21134374699SSimon Glass if (get_timer(start) > I2C_TIMEOUT_MS) { 21234374699SSimon Glass debug("I2C Read Data Timeout\n"); 21334374699SSimon Glass err = -ETIMEDOUT; 21434374699SSimon Glass rk_i2c_show_regs(regs); 21534374699SSimon Glass goto i2c_exit; 21634374699SSimon Glass } 21734374699SSimon Glass udelay(1); 21834374699SSimon Glass } 21934374699SSimon Glass 22034374699SSimon Glass for (i = 0; i < words_xferred; i++) { 22134374699SSimon Glass rxdata = readl(®s->rxdata[i]); 22234374699SSimon Glass debug("I2c Read RXDATA[%d] = 0x%x\n", i, rxdata); 22334374699SSimon Glass for (j = 0; j < 4; j++) { 22434374699SSimon Glass if ((i * 4 + j) == bytes_xferred) 22534374699SSimon Glass break; 22634374699SSimon Glass *pbuf++ = (rxdata >> (j * 8)) & 0xff; 22734374699SSimon Glass } 22834374699SSimon Glass } 22934374699SSimon Glass 23034374699SSimon Glass bytes_remain_len -= bytes_xferred; 23134374699SSimon Glass debug("I2C Read bytes_remain_len %d\n", bytes_remain_len); 23234374699SSimon Glass } 23334374699SSimon Glass 23434374699SSimon Glass i2c_exit: 23534374699SSimon Glass rk_i2c_send_stop_bit(i2c); 23634374699SSimon Glass rk_i2c_disable(i2c); 23734374699SSimon Glass 23834374699SSimon Glass return err; 23934374699SSimon Glass } 24034374699SSimon Glass 24134374699SSimon Glass static int rk_i2c_write(struct rk_i2c *i2c, uchar chip, uint reg, uint r_len, 24234374699SSimon Glass uchar *buf, uint b_len) 24334374699SSimon Glass { 24434374699SSimon Glass struct i2c_regs *regs = i2c->regs; 24534374699SSimon Glass int err; 24634374699SSimon Glass uchar *pbuf = buf; 24734374699SSimon Glass uint bytes_remain_len = b_len + r_len + 1; 24834374699SSimon Glass uint bytes_xferred = 0; 24934374699SSimon Glass uint words_xferred = 0; 25034374699SSimon Glass ulong start; 25134374699SSimon Glass uint txdata; 25234374699SSimon Glass uint i, j; 25334374699SSimon Glass 25434374699SSimon Glass debug("rk_i2c_write: chip = %d, reg = %d, r_len = %d, b_len = %d\n", 25534374699SSimon Glass chip, reg, r_len, b_len); 25634374699SSimon Glass err = rk_i2c_send_start_bit(i2c); 25734374699SSimon Glass if (err) 25834374699SSimon Glass return err; 25934374699SSimon Glass 26034374699SSimon Glass while (bytes_remain_len) { 26134374699SSimon Glass if (bytes_remain_len > RK_I2C_FIFO_SIZE) 26234374699SSimon Glass bytes_xferred = 32; 26334374699SSimon Glass else 26434374699SSimon Glass bytes_xferred = bytes_remain_len; 26534374699SSimon Glass words_xferred = DIV_ROUND_UP(bytes_xferred, 4); 26634374699SSimon Glass 26734374699SSimon Glass for (i = 0; i < words_xferred; i++) { 26834374699SSimon Glass txdata = 0; 26934374699SSimon Glass for (j = 0; j < 4; j++) { 27034374699SSimon Glass if ((i * 4 + j) == bytes_xferred) 27134374699SSimon Glass break; 27234374699SSimon Glass 27334374699SSimon Glass if (i == 0 && j == 0) { 27434374699SSimon Glass txdata |= (chip << 1); 27534374699SSimon Glass } else if (i == 0 && j <= r_len) { 27634374699SSimon Glass txdata |= (reg & 27734374699SSimon Glass (0xff << ((j - 1) * 8))) << 8; 27834374699SSimon Glass } else { 27934374699SSimon Glass txdata |= (*pbuf++)<<(j * 8); 28034374699SSimon Glass } 28134374699SSimon Glass writel(txdata, ®s->txdata[i]); 28234374699SSimon Glass } 28334374699SSimon Glass debug("I2c Write TXDATA[%d] = 0x%x\n", i, txdata); 28434374699SSimon Glass } 28534374699SSimon Glass 28634374699SSimon Glass writel(I2C_CON_EN | I2C_CON_MOD(I2C_MODE_TX), ®s->con); 28734374699SSimon Glass writel(bytes_xferred, ®s->mtxcnt); 28834374699SSimon Glass writel(I2C_MBTFIEN | I2C_NAKRCVIEN, ®s->ien); 28934374699SSimon Glass 29034374699SSimon Glass start = get_timer(0); 29134374699SSimon Glass while (1) { 29234374699SSimon Glass if (readl(®s->ipd) & I2C_NAKRCVIPD) { 29334374699SSimon Glass writel(I2C_NAKRCVIPD, ®s->ipd); 29434374699SSimon Glass err = -EREMOTEIO; 29534374699SSimon Glass } 29634374699SSimon Glass if (readl(®s->ipd) & I2C_MBTFIPD) { 29734374699SSimon Glass writel(I2C_MBTFIPD, ®s->ipd); 29834374699SSimon Glass break; 29934374699SSimon Glass } 30034374699SSimon Glass if (get_timer(start) > I2C_TIMEOUT_MS) { 30134374699SSimon Glass debug("I2C Write Data Timeout\n"); 30234374699SSimon Glass err = -ETIMEDOUT; 30334374699SSimon Glass rk_i2c_show_regs(regs); 30434374699SSimon Glass goto i2c_exit; 30534374699SSimon Glass } 30634374699SSimon Glass udelay(1); 30734374699SSimon Glass } 30834374699SSimon Glass 30934374699SSimon Glass bytes_remain_len -= bytes_xferred; 31034374699SSimon Glass debug("I2C Write bytes_remain_len %d\n", bytes_remain_len); 31134374699SSimon Glass } 31234374699SSimon Glass 31334374699SSimon Glass i2c_exit: 31434374699SSimon Glass rk_i2c_send_stop_bit(i2c); 31534374699SSimon Glass rk_i2c_disable(i2c); 31634374699SSimon Glass 31734374699SSimon Glass return err; 31834374699SSimon Glass } 31934374699SSimon Glass 32034374699SSimon Glass static int rockchip_i2c_xfer(struct udevice *bus, struct i2c_msg *msg, 32134374699SSimon Glass int nmsgs) 32234374699SSimon Glass { 32334374699SSimon Glass struct rk_i2c *i2c = dev_get_priv(bus); 32434374699SSimon Glass int ret; 32534374699SSimon Glass 32634374699SSimon Glass debug("i2c_xfer: %d messages\n", nmsgs); 32734374699SSimon Glass for (; nmsgs > 0; nmsgs--, msg++) { 32834374699SSimon Glass debug("i2c_xfer: chip=0x%x, len=0x%x\n", msg->addr, msg->len); 32934374699SSimon Glass if (msg->flags & I2C_M_RD) { 33034374699SSimon Glass ret = rk_i2c_read(i2c, msg->addr, 0, 0, msg->buf, 33134374699SSimon Glass msg->len); 33234374699SSimon Glass } else { 33334374699SSimon Glass ret = rk_i2c_write(i2c, msg->addr, 0, 0, msg->buf, 33434374699SSimon Glass msg->len); 33534374699SSimon Glass } 33634374699SSimon Glass if (ret) { 33734374699SSimon Glass debug("i2c_write: error sending\n"); 33834374699SSimon Glass return -EREMOTEIO; 33934374699SSimon Glass } 34034374699SSimon Glass } 34134374699SSimon Glass 34234374699SSimon Glass return 0; 34334374699SSimon Glass } 34434374699SSimon Glass 34534374699SSimon Glass int rockchip_i2c_set_bus_speed(struct udevice *bus, unsigned int speed) 34634374699SSimon Glass { 34734374699SSimon Glass struct rk_i2c *i2c = dev_get_priv(bus); 34834374699SSimon Glass 34934374699SSimon Glass rk_i2c_set_clk(i2c, speed); 35034374699SSimon Glass 35134374699SSimon Glass return 0; 35234374699SSimon Glass } 35334374699SSimon Glass 354*930bc374SSimon Glass static int rockchip_i2c_ofdata_to_platdata(struct udevice *bus) 35534374699SSimon Glass { 356*930bc374SSimon Glass struct rk_i2c *priv = dev_get_priv(bus); 35734374699SSimon Glass int ret; 35834374699SSimon Glass 359*930bc374SSimon Glass ret = clk_get_by_index(bus, 0, &priv->clk); 360*930bc374SSimon Glass if (ret < 0) { 361*930bc374SSimon Glass debug("%s: Could not get clock for %s: %d\n", __func__, 362*930bc374SSimon Glass bus->name, ret); 36334374699SSimon Glass return ret; 364*930bc374SSimon Glass } 365*930bc374SSimon Glass priv->clk_id = ret; 366*930bc374SSimon Glass 367*930bc374SSimon Glass return 0; 368*930bc374SSimon Glass } 369*930bc374SSimon Glass 370*930bc374SSimon Glass static int rockchip_i2c_probe(struct udevice *bus) 371*930bc374SSimon Glass { 372*930bc374SSimon Glass struct rk_i2c *priv = dev_get_priv(bus); 373*930bc374SSimon Glass 374*930bc374SSimon Glass priv->regs = (void *)dev_get_addr(bus); 375*930bc374SSimon Glass 376*930bc374SSimon Glass return 0; 37734374699SSimon Glass } 37834374699SSimon Glass 37934374699SSimon Glass static const struct dm_i2c_ops rockchip_i2c_ops = { 38034374699SSimon Glass .xfer = rockchip_i2c_xfer, 38134374699SSimon Glass .set_bus_speed = rockchip_i2c_set_bus_speed, 38234374699SSimon Glass }; 38334374699SSimon Glass 38434374699SSimon Glass static const struct udevice_id rockchip_i2c_ids[] = { 38534374699SSimon Glass { .compatible = "rockchip,rk3288-i2c" }, 38634374699SSimon Glass { } 38734374699SSimon Glass }; 38834374699SSimon Glass 38934374699SSimon Glass U_BOOT_DRIVER(i2c_rockchip) = { 39034374699SSimon Glass .name = "i2c_rockchip", 39134374699SSimon Glass .id = UCLASS_I2C, 39234374699SSimon Glass .of_match = rockchip_i2c_ids, 393*930bc374SSimon Glass .ofdata_to_platdata = rockchip_i2c_ofdata_to_platdata, 39434374699SSimon Glass .probe = rockchip_i2c_probe, 39534374699SSimon Glass .priv_auto_alloc_size = sizeof(struct rk_i2c), 39634374699SSimon Glass .ops = &rockchip_i2c_ops, 39734374699SSimon Glass }; 398