1c41aa3ceSMax Schwarz /* 2c41aa3ceSMax Schwarz * Driver for I2C adapter in Rockchip RK3xxx SoC 3c41aa3ceSMax Schwarz * 4c41aa3ceSMax Schwarz * Max Schwarz <max.schwarz@online.de> 5c41aa3ceSMax Schwarz * based on the patches by Rockchip Inc. 6c41aa3ceSMax Schwarz * 7c41aa3ceSMax Schwarz * This program is free software; you can redistribute it and/or modify 8c41aa3ceSMax Schwarz * it under the terms of the GNU General Public License version 2 as 9c41aa3ceSMax Schwarz * published by the Free Software Foundation. 10c41aa3ceSMax Schwarz */ 11c41aa3ceSMax Schwarz 12c41aa3ceSMax Schwarz #include <linux/kernel.h> 13c41aa3ceSMax Schwarz #include <linux/module.h> 14c41aa3ceSMax Schwarz #include <linux/i2c.h> 15c41aa3ceSMax Schwarz #include <linux/interrupt.h> 16c41aa3ceSMax Schwarz #include <linux/errno.h> 17c41aa3ceSMax Schwarz #include <linux/err.h> 18c41aa3ceSMax Schwarz #include <linux/platform_device.h> 19c41aa3ceSMax Schwarz #include <linux/io.h> 20c41aa3ceSMax Schwarz #include <linux/of_address.h> 21c41aa3ceSMax Schwarz #include <linux/of_irq.h> 22c41aa3ceSMax Schwarz #include <linux/spinlock.h> 23c41aa3ceSMax Schwarz #include <linux/clk.h> 24c41aa3ceSMax Schwarz #include <linux/wait.h> 25c41aa3ceSMax Schwarz #include <linux/mfd/syscon.h> 26c41aa3ceSMax Schwarz #include <linux/regmap.h> 27c41aa3ceSMax Schwarz 28c41aa3ceSMax Schwarz 29c41aa3ceSMax Schwarz /* Register Map */ 30c41aa3ceSMax Schwarz #define REG_CON 0x00 /* control register */ 31c41aa3ceSMax Schwarz #define REG_CLKDIV 0x04 /* clock divisor register */ 32c41aa3ceSMax Schwarz #define REG_MRXADDR 0x08 /* slave address for REGISTER_TX */ 33c41aa3ceSMax Schwarz #define REG_MRXRADDR 0x0c /* slave register address for REGISTER_TX */ 34c41aa3ceSMax Schwarz #define REG_MTXCNT 0x10 /* number of bytes to be transmitted */ 35c41aa3ceSMax Schwarz #define REG_MRXCNT 0x14 /* number of bytes to be received */ 36c41aa3ceSMax Schwarz #define REG_IEN 0x18 /* interrupt enable */ 37c41aa3ceSMax Schwarz #define REG_IPD 0x1c /* interrupt pending */ 38c41aa3ceSMax Schwarz #define REG_FCNT 0x20 /* finished count */ 39c41aa3ceSMax Schwarz 40c41aa3ceSMax Schwarz /* Data buffer offsets */ 41c41aa3ceSMax Schwarz #define TXBUFFER_BASE 0x100 42c41aa3ceSMax Schwarz #define RXBUFFER_BASE 0x200 43c41aa3ceSMax Schwarz 44c41aa3ceSMax Schwarz /* REG_CON bits */ 45c41aa3ceSMax Schwarz #define REG_CON_EN BIT(0) 46c41aa3ceSMax Schwarz enum { 47c41aa3ceSMax Schwarz REG_CON_MOD_TX = 0, /* transmit data */ 48c41aa3ceSMax Schwarz REG_CON_MOD_REGISTER_TX, /* select register and restart */ 49c41aa3ceSMax Schwarz REG_CON_MOD_RX, /* receive data */ 50c41aa3ceSMax Schwarz REG_CON_MOD_REGISTER_RX, /* broken: transmits read addr AND writes 51c41aa3ceSMax Schwarz * register addr */ 52c41aa3ceSMax Schwarz }; 53c41aa3ceSMax Schwarz #define REG_CON_MOD(mod) ((mod) << 1) 54c41aa3ceSMax Schwarz #define REG_CON_MOD_MASK (BIT(1) | BIT(2)) 55c41aa3ceSMax Schwarz #define REG_CON_START BIT(3) 56c41aa3ceSMax Schwarz #define REG_CON_STOP BIT(4) 57c41aa3ceSMax Schwarz #define REG_CON_LASTACK BIT(5) /* 1: send NACK after last received byte */ 58c41aa3ceSMax Schwarz #define REG_CON_ACTACK BIT(6) /* 1: stop if NACK is received */ 59c41aa3ceSMax Schwarz 60c41aa3ceSMax Schwarz /* REG_MRXADDR bits */ 61c41aa3ceSMax Schwarz #define REG_MRXADDR_VALID(x) BIT(24 + (x)) /* [x*8+7:x*8] of MRX[R]ADDR valid */ 62c41aa3ceSMax Schwarz 63c41aa3ceSMax Schwarz /* REG_IEN/REG_IPD bits */ 64c41aa3ceSMax Schwarz #define REG_INT_BTF BIT(0) /* a byte was transmitted */ 65c41aa3ceSMax Schwarz #define REG_INT_BRF BIT(1) /* a byte was received */ 66c41aa3ceSMax Schwarz #define REG_INT_MBTF BIT(2) /* master data transmit finished */ 67c41aa3ceSMax Schwarz #define REG_INT_MBRF BIT(3) /* master data receive finished */ 68c41aa3ceSMax Schwarz #define REG_INT_START BIT(4) /* START condition generated */ 69c41aa3ceSMax Schwarz #define REG_INT_STOP BIT(5) /* STOP condition generated */ 70c41aa3ceSMax Schwarz #define REG_INT_NAKRCV BIT(6) /* NACK received */ 71c41aa3ceSMax Schwarz #define REG_INT_ALL 0x7f 72c41aa3ceSMax Schwarz 73c41aa3ceSMax Schwarz /* Constants */ 74c41aa3ceSMax Schwarz #define WAIT_TIMEOUT 200 /* ms */ 75c41aa3ceSMax Schwarz #define DEFAULT_SCL_RATE (100 * 1000) /* Hz */ 76c41aa3ceSMax Schwarz 77c41aa3ceSMax Schwarz enum rk3x_i2c_state { 78c41aa3ceSMax Schwarz STATE_IDLE, 79c41aa3ceSMax Schwarz STATE_START, 80c41aa3ceSMax Schwarz STATE_READ, 81c41aa3ceSMax Schwarz STATE_WRITE, 82c41aa3ceSMax Schwarz STATE_STOP 83c41aa3ceSMax Schwarz }; 84c41aa3ceSMax Schwarz 85c41aa3ceSMax Schwarz /** 86c41aa3ceSMax Schwarz * @grf_offset: offset inside the grf regmap for setting the i2c type 87c41aa3ceSMax Schwarz */ 88c41aa3ceSMax Schwarz struct rk3x_i2c_soc_data { 89c41aa3ceSMax Schwarz int grf_offset; 90c41aa3ceSMax Schwarz }; 91c41aa3ceSMax Schwarz 92c41aa3ceSMax Schwarz struct rk3x_i2c { 93c41aa3ceSMax Schwarz struct i2c_adapter adap; 94c41aa3ceSMax Schwarz struct device *dev; 95c41aa3ceSMax Schwarz struct rk3x_i2c_soc_data *soc_data; 96c41aa3ceSMax Schwarz 97c41aa3ceSMax Schwarz /* Hardware resources */ 98c41aa3ceSMax Schwarz void __iomem *regs; 99c41aa3ceSMax Schwarz struct clk *clk; 100c41aa3ceSMax Schwarz 101c41aa3ceSMax Schwarz /* Settings */ 102c41aa3ceSMax Schwarz unsigned int scl_frequency; 103c41aa3ceSMax Schwarz 104c41aa3ceSMax Schwarz /* Synchronization & notification */ 105c41aa3ceSMax Schwarz spinlock_t lock; 106c41aa3ceSMax Schwarz wait_queue_head_t wait; 107c41aa3ceSMax Schwarz bool busy; 108c41aa3ceSMax Schwarz 109c41aa3ceSMax Schwarz /* Current message */ 110c41aa3ceSMax Schwarz struct i2c_msg *msg; 111c41aa3ceSMax Schwarz u8 addr; 112c41aa3ceSMax Schwarz unsigned int mode; 113c41aa3ceSMax Schwarz bool is_last_msg; 114c41aa3ceSMax Schwarz 115c41aa3ceSMax Schwarz /* I2C state machine */ 116c41aa3ceSMax Schwarz enum rk3x_i2c_state state; 117c41aa3ceSMax Schwarz unsigned int processed; /* sent/received bytes */ 118c41aa3ceSMax Schwarz int error; 119c41aa3ceSMax Schwarz }; 120c41aa3ceSMax Schwarz 121c41aa3ceSMax Schwarz static inline void i2c_writel(struct rk3x_i2c *i2c, u32 value, 122c41aa3ceSMax Schwarz unsigned int offset) 123c41aa3ceSMax Schwarz { 124c41aa3ceSMax Schwarz writel(value, i2c->regs + offset); 125c41aa3ceSMax Schwarz } 126c41aa3ceSMax Schwarz 127c41aa3ceSMax Schwarz static inline u32 i2c_readl(struct rk3x_i2c *i2c, unsigned int offset) 128c41aa3ceSMax Schwarz { 129c41aa3ceSMax Schwarz return readl(i2c->regs + offset); 130c41aa3ceSMax Schwarz } 131c41aa3ceSMax Schwarz 132c41aa3ceSMax Schwarz /* Reset all interrupt pending bits */ 133c41aa3ceSMax Schwarz static inline void rk3x_i2c_clean_ipd(struct rk3x_i2c *i2c) 134c41aa3ceSMax Schwarz { 135c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_ALL, REG_IPD); 136c41aa3ceSMax Schwarz } 137c41aa3ceSMax Schwarz 138c41aa3ceSMax Schwarz /** 139c41aa3ceSMax Schwarz * Generate a START condition, which triggers a REG_INT_START interrupt. 140c41aa3ceSMax Schwarz */ 141c41aa3ceSMax Schwarz static void rk3x_i2c_start(struct rk3x_i2c *i2c) 142c41aa3ceSMax Schwarz { 143c41aa3ceSMax Schwarz u32 val; 144c41aa3ceSMax Schwarz 145c41aa3ceSMax Schwarz rk3x_i2c_clean_ipd(i2c); 146c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_START, REG_IEN); 147c41aa3ceSMax Schwarz 148c41aa3ceSMax Schwarz /* enable adapter with correct mode, send START condition */ 149c41aa3ceSMax Schwarz val = REG_CON_EN | REG_CON_MOD(i2c->mode) | REG_CON_START; 150c41aa3ceSMax Schwarz 151c41aa3ceSMax Schwarz /* if we want to react to NACK, set ACTACK bit */ 152c41aa3ceSMax Schwarz if (!(i2c->msg->flags & I2C_M_IGNORE_NAK)) 153c41aa3ceSMax Schwarz val |= REG_CON_ACTACK; 154c41aa3ceSMax Schwarz 155c41aa3ceSMax Schwarz i2c_writel(i2c, val, REG_CON); 156c41aa3ceSMax Schwarz } 157c41aa3ceSMax Schwarz 158c41aa3ceSMax Schwarz /** 159c41aa3ceSMax Schwarz * Generate a STOP condition, which triggers a REG_INT_STOP interrupt. 160c41aa3ceSMax Schwarz * 161c41aa3ceSMax Schwarz * @error: Error code to return in rk3x_i2c_xfer 162c41aa3ceSMax Schwarz */ 163c41aa3ceSMax Schwarz static void rk3x_i2c_stop(struct rk3x_i2c *i2c, int error) 164c41aa3ceSMax Schwarz { 165c41aa3ceSMax Schwarz unsigned int ctrl; 166c41aa3ceSMax Schwarz 167c41aa3ceSMax Schwarz i2c->processed = 0; 168c41aa3ceSMax Schwarz i2c->msg = NULL; 169c41aa3ceSMax Schwarz i2c->error = error; 170c41aa3ceSMax Schwarz 171c41aa3ceSMax Schwarz if (i2c->is_last_msg) { 172c41aa3ceSMax Schwarz /* Enable stop interrupt */ 173c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_STOP, REG_IEN); 174c41aa3ceSMax Schwarz 175c41aa3ceSMax Schwarz i2c->state = STATE_STOP; 176c41aa3ceSMax Schwarz 177c41aa3ceSMax Schwarz ctrl = i2c_readl(i2c, REG_CON); 178c41aa3ceSMax Schwarz ctrl |= REG_CON_STOP; 179c41aa3ceSMax Schwarz i2c_writel(i2c, ctrl, REG_CON); 180c41aa3ceSMax Schwarz } else { 181c41aa3ceSMax Schwarz /* Signal rk3x_i2c_xfer to start the next message. */ 182c41aa3ceSMax Schwarz i2c->busy = false; 183c41aa3ceSMax Schwarz i2c->state = STATE_IDLE; 184c41aa3ceSMax Schwarz 185c41aa3ceSMax Schwarz /* 186c41aa3ceSMax Schwarz * The HW is actually not capable of REPEATED START. But we can 187c41aa3ceSMax Schwarz * get the intended effect by resetting its internal state 188c41aa3ceSMax Schwarz * and issuing an ordinary START. 189c41aa3ceSMax Schwarz */ 190c41aa3ceSMax Schwarz i2c_writel(i2c, 0, REG_CON); 191c41aa3ceSMax Schwarz 192c41aa3ceSMax Schwarz /* signal that we are finished with the current msg */ 193c41aa3ceSMax Schwarz wake_up(&i2c->wait); 194c41aa3ceSMax Schwarz } 195c41aa3ceSMax Schwarz } 196c41aa3ceSMax Schwarz 197c41aa3ceSMax Schwarz /** 198c41aa3ceSMax Schwarz * Setup a read according to i2c->msg 199c41aa3ceSMax Schwarz */ 200c41aa3ceSMax Schwarz static void rk3x_i2c_prepare_read(struct rk3x_i2c *i2c) 201c41aa3ceSMax Schwarz { 202c41aa3ceSMax Schwarz unsigned int len = i2c->msg->len - i2c->processed; 203c41aa3ceSMax Schwarz u32 con; 204c41aa3ceSMax Schwarz 205c41aa3ceSMax Schwarz con = i2c_readl(i2c, REG_CON); 206c41aa3ceSMax Schwarz 207c41aa3ceSMax Schwarz /* 208c41aa3ceSMax Schwarz * The hw can read up to 32 bytes at a time. If we need more than one 209c41aa3ceSMax Schwarz * chunk, send an ACK after the last byte of the current chunk. 210c41aa3ceSMax Schwarz */ 211c41aa3ceSMax Schwarz if (unlikely(len > 32)) { 212c41aa3ceSMax Schwarz len = 32; 213c41aa3ceSMax Schwarz con &= ~REG_CON_LASTACK; 214c41aa3ceSMax Schwarz } else { 215c41aa3ceSMax Schwarz con |= REG_CON_LASTACK; 216c41aa3ceSMax Schwarz } 217c41aa3ceSMax Schwarz 218c41aa3ceSMax Schwarz /* make sure we are in plain RX mode if we read a second chunk */ 219c41aa3ceSMax Schwarz if (i2c->processed != 0) { 220c41aa3ceSMax Schwarz con &= ~REG_CON_MOD_MASK; 221c41aa3ceSMax Schwarz con |= REG_CON_MOD(REG_CON_MOD_RX); 222c41aa3ceSMax Schwarz } 223c41aa3ceSMax Schwarz 224c41aa3ceSMax Schwarz i2c_writel(i2c, con, REG_CON); 225c41aa3ceSMax Schwarz i2c_writel(i2c, len, REG_MRXCNT); 226c41aa3ceSMax Schwarz } 227c41aa3ceSMax Schwarz 228c41aa3ceSMax Schwarz /** 229c41aa3ceSMax Schwarz * Fill the transmit buffer with data from i2c->msg 230c41aa3ceSMax Schwarz */ 231c41aa3ceSMax Schwarz static void rk3x_i2c_fill_transmit_buf(struct rk3x_i2c *i2c) 232c41aa3ceSMax Schwarz { 233c41aa3ceSMax Schwarz unsigned int i, j; 234c41aa3ceSMax Schwarz u32 cnt = 0; 235c41aa3ceSMax Schwarz u32 val; 236c41aa3ceSMax Schwarz u8 byte; 237c41aa3ceSMax Schwarz 238c41aa3ceSMax Schwarz for (i = 0; i < 8; ++i) { 239c41aa3ceSMax Schwarz val = 0; 240c41aa3ceSMax Schwarz for (j = 0; j < 4; ++j) { 241c41aa3ceSMax Schwarz if (i2c->processed == i2c->msg->len) 242c41aa3ceSMax Schwarz break; 243c41aa3ceSMax Schwarz 244c41aa3ceSMax Schwarz if (i2c->processed == 0 && cnt == 0) 245c41aa3ceSMax Schwarz byte = (i2c->addr & 0x7f) << 1; 246c41aa3ceSMax Schwarz else 247c41aa3ceSMax Schwarz byte = i2c->msg->buf[i2c->processed++]; 248c41aa3ceSMax Schwarz 249c41aa3ceSMax Schwarz val |= byte << (j * 8); 250c41aa3ceSMax Schwarz cnt++; 251c41aa3ceSMax Schwarz } 252c41aa3ceSMax Schwarz 253c41aa3ceSMax Schwarz i2c_writel(i2c, val, TXBUFFER_BASE + 4 * i); 254c41aa3ceSMax Schwarz 255c41aa3ceSMax Schwarz if (i2c->processed == i2c->msg->len) 256c41aa3ceSMax Schwarz break; 257c41aa3ceSMax Schwarz } 258c41aa3ceSMax Schwarz 259c41aa3ceSMax Schwarz i2c_writel(i2c, cnt, REG_MTXCNT); 260c41aa3ceSMax Schwarz } 261c41aa3ceSMax Schwarz 262c41aa3ceSMax Schwarz 263c41aa3ceSMax Schwarz /* IRQ handlers for individual states */ 264c41aa3ceSMax Schwarz 265c41aa3ceSMax Schwarz static void rk3x_i2c_handle_start(struct rk3x_i2c *i2c, unsigned int ipd) 266c41aa3ceSMax Schwarz { 267c41aa3ceSMax Schwarz if (!(ipd & REG_INT_START)) { 268c41aa3ceSMax Schwarz rk3x_i2c_stop(i2c, -EIO); 269c41aa3ceSMax Schwarz dev_warn(i2c->dev, "unexpected irq in START: 0x%x\n", ipd); 270c41aa3ceSMax Schwarz rk3x_i2c_clean_ipd(i2c); 271c41aa3ceSMax Schwarz return; 272c41aa3ceSMax Schwarz } 273c41aa3ceSMax Schwarz 274c41aa3ceSMax Schwarz /* ack interrupt */ 275c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_START, REG_IPD); 276c41aa3ceSMax Schwarz 277c41aa3ceSMax Schwarz /* disable start bit */ 278c41aa3ceSMax Schwarz i2c_writel(i2c, i2c_readl(i2c, REG_CON) & ~REG_CON_START, REG_CON); 279c41aa3ceSMax Schwarz 280c41aa3ceSMax Schwarz /* enable appropriate interrupts and transition */ 281c41aa3ceSMax Schwarz if (i2c->mode == REG_CON_MOD_TX) { 282c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_MBTF | REG_INT_NAKRCV, REG_IEN); 283c41aa3ceSMax Schwarz i2c->state = STATE_WRITE; 284c41aa3ceSMax Schwarz rk3x_i2c_fill_transmit_buf(i2c); 285c41aa3ceSMax Schwarz } else { 286c41aa3ceSMax Schwarz /* in any other case, we are going to be reading. */ 287c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_MBRF | REG_INT_NAKRCV, REG_IEN); 288c41aa3ceSMax Schwarz i2c->state = STATE_READ; 289c41aa3ceSMax Schwarz rk3x_i2c_prepare_read(i2c); 290c41aa3ceSMax Schwarz } 291c41aa3ceSMax Schwarz } 292c41aa3ceSMax Schwarz 293c41aa3ceSMax Schwarz static void rk3x_i2c_handle_write(struct rk3x_i2c *i2c, unsigned int ipd) 294c41aa3ceSMax Schwarz { 295c41aa3ceSMax Schwarz if (!(ipd & REG_INT_MBTF)) { 296c41aa3ceSMax Schwarz rk3x_i2c_stop(i2c, -EIO); 297c41aa3ceSMax Schwarz dev_err(i2c->dev, "unexpected irq in WRITE: 0x%x\n", ipd); 298c41aa3ceSMax Schwarz rk3x_i2c_clean_ipd(i2c); 299c41aa3ceSMax Schwarz return; 300c41aa3ceSMax Schwarz } 301c41aa3ceSMax Schwarz 302c41aa3ceSMax Schwarz /* ack interrupt */ 303c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_MBTF, REG_IPD); 304c41aa3ceSMax Schwarz 305c41aa3ceSMax Schwarz /* are we finished? */ 306c41aa3ceSMax Schwarz if (i2c->processed == i2c->msg->len) 307c41aa3ceSMax Schwarz rk3x_i2c_stop(i2c, i2c->error); 308c41aa3ceSMax Schwarz else 309c41aa3ceSMax Schwarz rk3x_i2c_fill_transmit_buf(i2c); 310c41aa3ceSMax Schwarz } 311c41aa3ceSMax Schwarz 312c41aa3ceSMax Schwarz static void rk3x_i2c_handle_read(struct rk3x_i2c *i2c, unsigned int ipd) 313c41aa3ceSMax Schwarz { 314c41aa3ceSMax Schwarz unsigned int i; 315c41aa3ceSMax Schwarz unsigned int len = i2c->msg->len - i2c->processed; 316c41aa3ceSMax Schwarz u32 uninitialized_var(val); 317c41aa3ceSMax Schwarz u8 byte; 318c41aa3ceSMax Schwarz 319c41aa3ceSMax Schwarz /* we only care for MBRF here. */ 320c41aa3ceSMax Schwarz if (!(ipd & REG_INT_MBRF)) 321c41aa3ceSMax Schwarz return; 322c41aa3ceSMax Schwarz 323c41aa3ceSMax Schwarz /* ack interrupt */ 324c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_MBRF, REG_IPD); 325c41aa3ceSMax Schwarz 326*5da4309fSaddy ke /* Can only handle a maximum of 32 bytes at a time */ 327*5da4309fSaddy ke if (len > 32) 328*5da4309fSaddy ke len = 32; 329*5da4309fSaddy ke 330c41aa3ceSMax Schwarz /* read the data from receive buffer */ 331c41aa3ceSMax Schwarz for (i = 0; i < len; ++i) { 332c41aa3ceSMax Schwarz if (i % 4 == 0) 333c41aa3ceSMax Schwarz val = i2c_readl(i2c, RXBUFFER_BASE + (i / 4) * 4); 334c41aa3ceSMax Schwarz 335c41aa3ceSMax Schwarz byte = (val >> ((i % 4) * 8)) & 0xff; 336c41aa3ceSMax Schwarz i2c->msg->buf[i2c->processed++] = byte; 337c41aa3ceSMax Schwarz } 338c41aa3ceSMax Schwarz 339c41aa3ceSMax Schwarz /* are we finished? */ 340c41aa3ceSMax Schwarz if (i2c->processed == i2c->msg->len) 341c41aa3ceSMax Schwarz rk3x_i2c_stop(i2c, i2c->error); 342c41aa3ceSMax Schwarz else 343c41aa3ceSMax Schwarz rk3x_i2c_prepare_read(i2c); 344c41aa3ceSMax Schwarz } 345c41aa3ceSMax Schwarz 346c41aa3ceSMax Schwarz static void rk3x_i2c_handle_stop(struct rk3x_i2c *i2c, unsigned int ipd) 347c41aa3ceSMax Schwarz { 348c41aa3ceSMax Schwarz unsigned int con; 349c41aa3ceSMax Schwarz 350c41aa3ceSMax Schwarz if (!(ipd & REG_INT_STOP)) { 351c41aa3ceSMax Schwarz rk3x_i2c_stop(i2c, -EIO); 352c41aa3ceSMax Schwarz dev_err(i2c->dev, "unexpected irq in STOP: 0x%x\n", ipd); 353c41aa3ceSMax Schwarz rk3x_i2c_clean_ipd(i2c); 354c41aa3ceSMax Schwarz return; 355c41aa3ceSMax Schwarz } 356c41aa3ceSMax Schwarz 357c41aa3ceSMax Schwarz /* ack interrupt */ 358c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_STOP, REG_IPD); 359c41aa3ceSMax Schwarz 360c41aa3ceSMax Schwarz /* disable STOP bit */ 361c41aa3ceSMax Schwarz con = i2c_readl(i2c, REG_CON); 362c41aa3ceSMax Schwarz con &= ~REG_CON_STOP; 363c41aa3ceSMax Schwarz i2c_writel(i2c, con, REG_CON); 364c41aa3ceSMax Schwarz 365c41aa3ceSMax Schwarz i2c->busy = false; 366c41aa3ceSMax Schwarz i2c->state = STATE_IDLE; 367c41aa3ceSMax Schwarz 368c41aa3ceSMax Schwarz /* signal rk3x_i2c_xfer that we are finished */ 369c41aa3ceSMax Schwarz wake_up(&i2c->wait); 370c41aa3ceSMax Schwarz } 371c41aa3ceSMax Schwarz 372c41aa3ceSMax Schwarz static irqreturn_t rk3x_i2c_irq(int irqno, void *dev_id) 373c41aa3ceSMax Schwarz { 374c41aa3ceSMax Schwarz struct rk3x_i2c *i2c = dev_id; 375c41aa3ceSMax Schwarz unsigned int ipd; 376c41aa3ceSMax Schwarz 377c41aa3ceSMax Schwarz spin_lock(&i2c->lock); 378c41aa3ceSMax Schwarz 379c41aa3ceSMax Schwarz ipd = i2c_readl(i2c, REG_IPD); 380c41aa3ceSMax Schwarz if (i2c->state == STATE_IDLE) { 381c41aa3ceSMax Schwarz dev_warn(i2c->dev, "irq in STATE_IDLE, ipd = 0x%x\n", ipd); 382c41aa3ceSMax Schwarz rk3x_i2c_clean_ipd(i2c); 383c41aa3ceSMax Schwarz goto out; 384c41aa3ceSMax Schwarz } 385c41aa3ceSMax Schwarz 386c41aa3ceSMax Schwarz dev_dbg(i2c->dev, "IRQ: state %d, ipd: %x\n", i2c->state, ipd); 387c41aa3ceSMax Schwarz 388c41aa3ceSMax Schwarz /* Clean interrupt bits we don't care about */ 389c41aa3ceSMax Schwarz ipd &= ~(REG_INT_BRF | REG_INT_BTF); 390c41aa3ceSMax Schwarz 391c41aa3ceSMax Schwarz if (ipd & REG_INT_NAKRCV) { 392c41aa3ceSMax Schwarz /* 393c41aa3ceSMax Schwarz * We got a NACK in the last operation. Depending on whether 394c41aa3ceSMax Schwarz * IGNORE_NAK is set, we have to stop the operation and report 395c41aa3ceSMax Schwarz * an error. 396c41aa3ceSMax Schwarz */ 397c41aa3ceSMax Schwarz i2c_writel(i2c, REG_INT_NAKRCV, REG_IPD); 398c41aa3ceSMax Schwarz 399c41aa3ceSMax Schwarz ipd &= ~REG_INT_NAKRCV; 400c41aa3ceSMax Schwarz 401c41aa3ceSMax Schwarz if (!(i2c->msg->flags & I2C_M_IGNORE_NAK)) 402c41aa3ceSMax Schwarz rk3x_i2c_stop(i2c, -ENXIO); 403c41aa3ceSMax Schwarz } 404c41aa3ceSMax Schwarz 405c41aa3ceSMax Schwarz /* is there anything left to handle? */ 4069c5f7cadSaddy ke if (unlikely((ipd & REG_INT_ALL) == 0)) 407c41aa3ceSMax Schwarz goto out; 408c41aa3ceSMax Schwarz 409c41aa3ceSMax Schwarz switch (i2c->state) { 410c41aa3ceSMax Schwarz case STATE_START: 411c41aa3ceSMax Schwarz rk3x_i2c_handle_start(i2c, ipd); 412c41aa3ceSMax Schwarz break; 413c41aa3ceSMax Schwarz case STATE_WRITE: 414c41aa3ceSMax Schwarz rk3x_i2c_handle_write(i2c, ipd); 415c41aa3ceSMax Schwarz break; 416c41aa3ceSMax Schwarz case STATE_READ: 417c41aa3ceSMax Schwarz rk3x_i2c_handle_read(i2c, ipd); 418c41aa3ceSMax Schwarz break; 419c41aa3ceSMax Schwarz case STATE_STOP: 420c41aa3ceSMax Schwarz rk3x_i2c_handle_stop(i2c, ipd); 421c41aa3ceSMax Schwarz break; 422c41aa3ceSMax Schwarz case STATE_IDLE: 423c41aa3ceSMax Schwarz break; 424c41aa3ceSMax Schwarz } 425c41aa3ceSMax Schwarz 426c41aa3ceSMax Schwarz out: 427c41aa3ceSMax Schwarz spin_unlock(&i2c->lock); 428c41aa3ceSMax Schwarz return IRQ_HANDLED; 429c41aa3ceSMax Schwarz } 430c41aa3ceSMax Schwarz 431c41aa3ceSMax Schwarz static void rk3x_i2c_set_scl_rate(struct rk3x_i2c *i2c, unsigned long scl_rate) 432c41aa3ceSMax Schwarz { 433c41aa3ceSMax Schwarz unsigned long i2c_rate = clk_get_rate(i2c->clk); 434c41aa3ceSMax Schwarz unsigned int div; 435c41aa3ceSMax Schwarz 436c41aa3ceSMax Schwarz /* SCL rate = (clk rate) / (8 * DIV) */ 437c41aa3ceSMax Schwarz div = DIV_ROUND_UP(i2c_rate, scl_rate * 8); 438c41aa3ceSMax Schwarz 439c41aa3ceSMax Schwarz /* The lower and upper half of the CLKDIV reg describe the length of 440c41aa3ceSMax Schwarz * SCL low & high periods. */ 441c41aa3ceSMax Schwarz div = DIV_ROUND_UP(div, 2); 442c41aa3ceSMax Schwarz 443c41aa3ceSMax Schwarz i2c_writel(i2c, (div << 16) | (div & 0xffff), REG_CLKDIV); 444c41aa3ceSMax Schwarz } 445c41aa3ceSMax Schwarz 446c41aa3ceSMax Schwarz /** 447c41aa3ceSMax Schwarz * Setup I2C registers for an I2C operation specified by msgs, num. 448c41aa3ceSMax Schwarz * 449c41aa3ceSMax Schwarz * Must be called with i2c->lock held. 450c41aa3ceSMax Schwarz * 451c41aa3ceSMax Schwarz * @msgs: I2C msgs to process 452c41aa3ceSMax Schwarz * @num: Number of msgs 453c41aa3ceSMax Schwarz * 454c41aa3ceSMax Schwarz * returns: Number of I2C msgs processed or negative in case of error 455c41aa3ceSMax Schwarz */ 456c41aa3ceSMax Schwarz static int rk3x_i2c_setup(struct rk3x_i2c *i2c, struct i2c_msg *msgs, int num) 457c41aa3ceSMax Schwarz { 458c41aa3ceSMax Schwarz u32 addr = (msgs[0].addr & 0x7f) << 1; 459c41aa3ceSMax Schwarz int ret = 0; 460c41aa3ceSMax Schwarz 461c41aa3ceSMax Schwarz /* 462c41aa3ceSMax Schwarz * The I2C adapter can issue a small (len < 4) write packet before 463c41aa3ceSMax Schwarz * reading. This speeds up SMBus-style register reads. 464c41aa3ceSMax Schwarz * The MRXADDR/MRXRADDR hold the slave address and the slave register 465c41aa3ceSMax Schwarz * address in this case. 466c41aa3ceSMax Schwarz */ 467c41aa3ceSMax Schwarz 468c41aa3ceSMax Schwarz if (num >= 2 && msgs[0].len < 4 && 469c41aa3ceSMax Schwarz !(msgs[0].flags & I2C_M_RD) && (msgs[1].flags & I2C_M_RD)) { 470c41aa3ceSMax Schwarz u32 reg_addr = 0; 471c41aa3ceSMax Schwarz int i; 472c41aa3ceSMax Schwarz 473c41aa3ceSMax Schwarz dev_dbg(i2c->dev, "Combined write/read from addr 0x%x\n", 474c41aa3ceSMax Schwarz addr >> 1); 475c41aa3ceSMax Schwarz 476c41aa3ceSMax Schwarz /* Fill MRXRADDR with the register address(es) */ 477c41aa3ceSMax Schwarz for (i = 0; i < msgs[0].len; ++i) { 478c41aa3ceSMax Schwarz reg_addr |= msgs[0].buf[i] << (i * 8); 479c41aa3ceSMax Schwarz reg_addr |= REG_MRXADDR_VALID(i); 480c41aa3ceSMax Schwarz } 481c41aa3ceSMax Schwarz 482c41aa3ceSMax Schwarz /* msgs[0] is handled by hw. */ 483c41aa3ceSMax Schwarz i2c->msg = &msgs[1]; 484c41aa3ceSMax Schwarz 485c41aa3ceSMax Schwarz i2c->mode = REG_CON_MOD_REGISTER_TX; 486c41aa3ceSMax Schwarz 487c41aa3ceSMax Schwarz i2c_writel(i2c, addr | REG_MRXADDR_VALID(0), REG_MRXADDR); 488c41aa3ceSMax Schwarz i2c_writel(i2c, reg_addr, REG_MRXRADDR); 489c41aa3ceSMax Schwarz 490c41aa3ceSMax Schwarz ret = 2; 491c41aa3ceSMax Schwarz } else { 492c41aa3ceSMax Schwarz /* 493c41aa3ceSMax Schwarz * We'll have to do it the boring way and process the msgs 494c41aa3ceSMax Schwarz * one-by-one. 495c41aa3ceSMax Schwarz */ 496c41aa3ceSMax Schwarz 497c41aa3ceSMax Schwarz if (msgs[0].flags & I2C_M_RD) { 498c41aa3ceSMax Schwarz addr |= 1; /* set read bit */ 499c41aa3ceSMax Schwarz 500c41aa3ceSMax Schwarz /* 501c41aa3ceSMax Schwarz * We have to transmit the slave addr first. Use 502c41aa3ceSMax Schwarz * MOD_REGISTER_TX for that purpose. 503c41aa3ceSMax Schwarz */ 504c41aa3ceSMax Schwarz i2c->mode = REG_CON_MOD_REGISTER_TX; 505c41aa3ceSMax Schwarz i2c_writel(i2c, addr | REG_MRXADDR_VALID(0), 506c41aa3ceSMax Schwarz REG_MRXADDR); 507c41aa3ceSMax Schwarz i2c_writel(i2c, 0, REG_MRXRADDR); 508c41aa3ceSMax Schwarz } else { 509c41aa3ceSMax Schwarz i2c->mode = REG_CON_MOD_TX; 510c41aa3ceSMax Schwarz } 511c41aa3ceSMax Schwarz 512c41aa3ceSMax Schwarz i2c->msg = &msgs[0]; 513c41aa3ceSMax Schwarz 514c41aa3ceSMax Schwarz ret = 1; 515c41aa3ceSMax Schwarz } 516c41aa3ceSMax Schwarz 517c41aa3ceSMax Schwarz i2c->addr = msgs[0].addr; 518c41aa3ceSMax Schwarz i2c->busy = true; 519c41aa3ceSMax Schwarz i2c->state = STATE_START; 520c41aa3ceSMax Schwarz i2c->processed = 0; 521c41aa3ceSMax Schwarz i2c->error = 0; 522c41aa3ceSMax Schwarz 523c41aa3ceSMax Schwarz rk3x_i2c_clean_ipd(i2c); 524c41aa3ceSMax Schwarz 525c41aa3ceSMax Schwarz return ret; 526c41aa3ceSMax Schwarz } 527c41aa3ceSMax Schwarz 528c41aa3ceSMax Schwarz static int rk3x_i2c_xfer(struct i2c_adapter *adap, 529c41aa3ceSMax Schwarz struct i2c_msg *msgs, int num) 530c41aa3ceSMax Schwarz { 531c41aa3ceSMax Schwarz struct rk3x_i2c *i2c = (struct rk3x_i2c *)adap->algo_data; 532c41aa3ceSMax Schwarz unsigned long timeout, flags; 533c41aa3ceSMax Schwarz int ret = 0; 534c41aa3ceSMax Schwarz int i; 535c41aa3ceSMax Schwarz 536c41aa3ceSMax Schwarz spin_lock_irqsave(&i2c->lock, flags); 537c41aa3ceSMax Schwarz 538c41aa3ceSMax Schwarz clk_enable(i2c->clk); 539c41aa3ceSMax Schwarz 540c41aa3ceSMax Schwarz /* The clock rate might have changed, so setup the divider again */ 541c41aa3ceSMax Schwarz rk3x_i2c_set_scl_rate(i2c, i2c->scl_frequency); 542c41aa3ceSMax Schwarz 543c41aa3ceSMax Schwarz i2c->is_last_msg = false; 544c41aa3ceSMax Schwarz 545c41aa3ceSMax Schwarz /* 546c41aa3ceSMax Schwarz * Process msgs. We can handle more than one message at once (see 547c41aa3ceSMax Schwarz * rk3x_i2c_setup()). 548c41aa3ceSMax Schwarz */ 549c41aa3ceSMax Schwarz for (i = 0; i < num; i += ret) { 550c41aa3ceSMax Schwarz ret = rk3x_i2c_setup(i2c, msgs + i, num - i); 551c41aa3ceSMax Schwarz 552c41aa3ceSMax Schwarz if (ret < 0) { 553c41aa3ceSMax Schwarz dev_err(i2c->dev, "rk3x_i2c_setup() failed\n"); 554c41aa3ceSMax Schwarz break; 555c41aa3ceSMax Schwarz } 556c41aa3ceSMax Schwarz 557c41aa3ceSMax Schwarz if (i + ret >= num) 558c41aa3ceSMax Schwarz i2c->is_last_msg = true; 559c41aa3ceSMax Schwarz 560c41aa3ceSMax Schwarz spin_unlock_irqrestore(&i2c->lock, flags); 561c41aa3ceSMax Schwarz 562c41aa3ceSMax Schwarz rk3x_i2c_start(i2c); 563c41aa3ceSMax Schwarz 564c41aa3ceSMax Schwarz timeout = wait_event_timeout(i2c->wait, !i2c->busy, 565c41aa3ceSMax Schwarz msecs_to_jiffies(WAIT_TIMEOUT)); 566c41aa3ceSMax Schwarz 567c41aa3ceSMax Schwarz spin_lock_irqsave(&i2c->lock, flags); 568c41aa3ceSMax Schwarz 569c41aa3ceSMax Schwarz if (timeout == 0) { 570c41aa3ceSMax Schwarz dev_err(i2c->dev, "timeout, ipd: 0x%02x, state: %d\n", 571c41aa3ceSMax Schwarz i2c_readl(i2c, REG_IPD), i2c->state); 572c41aa3ceSMax Schwarz 573c41aa3ceSMax Schwarz /* Force a STOP condition without interrupt */ 574c41aa3ceSMax Schwarz i2c_writel(i2c, 0, REG_IEN); 575c41aa3ceSMax Schwarz i2c_writel(i2c, REG_CON_EN | REG_CON_STOP, REG_CON); 576c41aa3ceSMax Schwarz 577c41aa3ceSMax Schwarz i2c->state = STATE_IDLE; 578c41aa3ceSMax Schwarz 579c41aa3ceSMax Schwarz ret = -ETIMEDOUT; 580c41aa3ceSMax Schwarz break; 581c41aa3ceSMax Schwarz } 582c41aa3ceSMax Schwarz 583c41aa3ceSMax Schwarz if (i2c->error) { 584c41aa3ceSMax Schwarz ret = i2c->error; 585c41aa3ceSMax Schwarz break; 586c41aa3ceSMax Schwarz } 587c41aa3ceSMax Schwarz } 588c41aa3ceSMax Schwarz 589c41aa3ceSMax Schwarz clk_disable(i2c->clk); 590c41aa3ceSMax Schwarz spin_unlock_irqrestore(&i2c->lock, flags); 591c41aa3ceSMax Schwarz 592c41aa3ceSMax Schwarz return ret; 593c41aa3ceSMax Schwarz } 594c41aa3ceSMax Schwarz 595c41aa3ceSMax Schwarz static u32 rk3x_i2c_func(struct i2c_adapter *adap) 596c41aa3ceSMax Schwarz { 597c41aa3ceSMax Schwarz return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL | I2C_FUNC_PROTOCOL_MANGLING; 598c41aa3ceSMax Schwarz } 599c41aa3ceSMax Schwarz 600c41aa3ceSMax Schwarz static const struct i2c_algorithm rk3x_i2c_algorithm = { 601c41aa3ceSMax Schwarz .master_xfer = rk3x_i2c_xfer, 602c41aa3ceSMax Schwarz .functionality = rk3x_i2c_func, 603c41aa3ceSMax Schwarz }; 604c41aa3ceSMax Schwarz 605c41aa3ceSMax Schwarz static struct rk3x_i2c_soc_data soc_data[3] = { 606c41aa3ceSMax Schwarz { .grf_offset = 0x154 }, /* rk3066 */ 607c41aa3ceSMax Schwarz { .grf_offset = 0x0a4 }, /* rk3188 */ 608c41aa3ceSMax Schwarz { .grf_offset = -1 }, /* no I2C switching needed */ 609c41aa3ceSMax Schwarz }; 610c41aa3ceSMax Schwarz 611c41aa3ceSMax Schwarz static const struct of_device_id rk3x_i2c_match[] = { 612c41aa3ceSMax Schwarz { .compatible = "rockchip,rk3066-i2c", .data = (void *)&soc_data[0] }, 613c41aa3ceSMax Schwarz { .compatible = "rockchip,rk3188-i2c", .data = (void *)&soc_data[1] }, 614c41aa3ceSMax Schwarz { .compatible = "rockchip,rk3288-i2c", .data = (void *)&soc_data[2] }, 615c51bd6acSDan Carpenter {}, 616c41aa3ceSMax Schwarz }; 617c41aa3ceSMax Schwarz 618c41aa3ceSMax Schwarz static int rk3x_i2c_probe(struct platform_device *pdev) 619c41aa3ceSMax Schwarz { 620c41aa3ceSMax Schwarz struct device_node *np = pdev->dev.of_node; 621c41aa3ceSMax Schwarz const struct of_device_id *match; 622c41aa3ceSMax Schwarz struct rk3x_i2c *i2c; 623c41aa3ceSMax Schwarz struct resource *mem; 624c41aa3ceSMax Schwarz int ret = 0; 625c41aa3ceSMax Schwarz int bus_nr; 626c41aa3ceSMax Schwarz u32 value; 627c41aa3ceSMax Schwarz int irq; 628c41aa3ceSMax Schwarz 629c41aa3ceSMax Schwarz i2c = devm_kzalloc(&pdev->dev, sizeof(struct rk3x_i2c), GFP_KERNEL); 630c41aa3ceSMax Schwarz if (!i2c) 631c41aa3ceSMax Schwarz return -ENOMEM; 632c41aa3ceSMax Schwarz 633c41aa3ceSMax Schwarz match = of_match_node(rk3x_i2c_match, np); 634c41aa3ceSMax Schwarz i2c->soc_data = (struct rk3x_i2c_soc_data *)match->data; 635c41aa3ceSMax Schwarz 636c41aa3ceSMax Schwarz if (of_property_read_u32(pdev->dev.of_node, "clock-frequency", 637c41aa3ceSMax Schwarz &i2c->scl_frequency)) { 638c41aa3ceSMax Schwarz dev_info(&pdev->dev, "using default SCL frequency: %d\n", 639c41aa3ceSMax Schwarz DEFAULT_SCL_RATE); 640c41aa3ceSMax Schwarz i2c->scl_frequency = DEFAULT_SCL_RATE; 641c41aa3ceSMax Schwarz } 642c41aa3ceSMax Schwarz 643c41aa3ceSMax Schwarz if (i2c->scl_frequency == 0 || i2c->scl_frequency > 400 * 1000) { 644c41aa3ceSMax Schwarz dev_warn(&pdev->dev, "invalid SCL frequency specified.\n"); 645c41aa3ceSMax Schwarz dev_warn(&pdev->dev, "using default SCL frequency: %d\n", 646c41aa3ceSMax Schwarz DEFAULT_SCL_RATE); 647c41aa3ceSMax Schwarz i2c->scl_frequency = DEFAULT_SCL_RATE; 648c41aa3ceSMax Schwarz } 649c41aa3ceSMax Schwarz 650c41aa3ceSMax Schwarz strlcpy(i2c->adap.name, "rk3x-i2c", sizeof(i2c->adap.name)); 651c41aa3ceSMax Schwarz i2c->adap.owner = THIS_MODULE; 652c41aa3ceSMax Schwarz i2c->adap.algo = &rk3x_i2c_algorithm; 653c41aa3ceSMax Schwarz i2c->adap.retries = 3; 654c41aa3ceSMax Schwarz i2c->adap.dev.of_node = np; 655c41aa3ceSMax Schwarz i2c->adap.algo_data = i2c; 656c41aa3ceSMax Schwarz i2c->adap.dev.parent = &pdev->dev; 657c41aa3ceSMax Schwarz 658c41aa3ceSMax Schwarz i2c->dev = &pdev->dev; 659c41aa3ceSMax Schwarz 660c41aa3ceSMax Schwarz spin_lock_init(&i2c->lock); 661c41aa3ceSMax Schwarz init_waitqueue_head(&i2c->wait); 662c41aa3ceSMax Schwarz 663c41aa3ceSMax Schwarz i2c->clk = devm_clk_get(&pdev->dev, NULL); 664c41aa3ceSMax Schwarz if (IS_ERR(i2c->clk)) { 665c41aa3ceSMax Schwarz dev_err(&pdev->dev, "cannot get clock\n"); 666c41aa3ceSMax Schwarz return PTR_ERR(i2c->clk); 667c41aa3ceSMax Schwarz } 668c41aa3ceSMax Schwarz 669c41aa3ceSMax Schwarz mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 670c41aa3ceSMax Schwarz i2c->regs = devm_ioremap_resource(&pdev->dev, mem); 671c41aa3ceSMax Schwarz if (IS_ERR(i2c->regs)) 672c41aa3ceSMax Schwarz return PTR_ERR(i2c->regs); 673c41aa3ceSMax Schwarz 674c41aa3ceSMax Schwarz /* Try to set the I2C adapter number from dt */ 675c41aa3ceSMax Schwarz bus_nr = of_alias_get_id(np, "i2c"); 676c41aa3ceSMax Schwarz 677c41aa3ceSMax Schwarz /* 678c41aa3ceSMax Schwarz * Switch to new interface if the SoC also offers the old one. 679c41aa3ceSMax Schwarz * The control bit is located in the GRF register space. 680c41aa3ceSMax Schwarz */ 681c41aa3ceSMax Schwarz if (i2c->soc_data->grf_offset >= 0) { 682c41aa3ceSMax Schwarz struct regmap *grf; 683c41aa3ceSMax Schwarz 684c41aa3ceSMax Schwarz grf = syscon_regmap_lookup_by_phandle(np, "rockchip,grf"); 685c41aa3ceSMax Schwarz if (IS_ERR(grf)) { 686c41aa3ceSMax Schwarz dev_err(&pdev->dev, 687c41aa3ceSMax Schwarz "rk3x-i2c needs 'rockchip,grf' property\n"); 688c41aa3ceSMax Schwarz return PTR_ERR(grf); 689c41aa3ceSMax Schwarz } 690c41aa3ceSMax Schwarz 691c41aa3ceSMax Schwarz if (bus_nr < 0) { 692c41aa3ceSMax Schwarz dev_err(&pdev->dev, "rk3x-i2c needs i2cX alias"); 693c41aa3ceSMax Schwarz return -EINVAL; 694c41aa3ceSMax Schwarz } 695c41aa3ceSMax Schwarz 696c41aa3ceSMax Schwarz /* 27+i: write mask, 11+i: value */ 697c41aa3ceSMax Schwarz value = BIT(27 + bus_nr) | BIT(11 + bus_nr); 698c41aa3ceSMax Schwarz 699c41aa3ceSMax Schwarz ret = regmap_write(grf, i2c->soc_data->grf_offset, value); 700c41aa3ceSMax Schwarz if (ret != 0) { 701c41aa3ceSMax Schwarz dev_err(i2c->dev, "Could not write to GRF: %d\n", ret); 702c41aa3ceSMax Schwarz return ret; 703c41aa3ceSMax Schwarz } 704c41aa3ceSMax Schwarz } 705c41aa3ceSMax Schwarz 706c41aa3ceSMax Schwarz /* IRQ setup */ 707c41aa3ceSMax Schwarz irq = platform_get_irq(pdev, 0); 708c41aa3ceSMax Schwarz if (irq < 0) { 709c41aa3ceSMax Schwarz dev_err(&pdev->dev, "cannot find rk3x IRQ\n"); 710c41aa3ceSMax Schwarz return irq; 711c41aa3ceSMax Schwarz } 712c41aa3ceSMax Schwarz 713c41aa3ceSMax Schwarz ret = devm_request_irq(&pdev->dev, irq, rk3x_i2c_irq, 714c41aa3ceSMax Schwarz 0, dev_name(&pdev->dev), i2c); 715c41aa3ceSMax Schwarz if (ret < 0) { 716c41aa3ceSMax Schwarz dev_err(&pdev->dev, "cannot request IRQ\n"); 717c41aa3ceSMax Schwarz return ret; 718c41aa3ceSMax Schwarz } 719c41aa3ceSMax Schwarz 720c41aa3ceSMax Schwarz platform_set_drvdata(pdev, i2c); 721c41aa3ceSMax Schwarz 722c41aa3ceSMax Schwarz ret = clk_prepare(i2c->clk); 723c41aa3ceSMax Schwarz if (ret < 0) { 724c41aa3ceSMax Schwarz dev_err(&pdev->dev, "Could not prepare clock\n"); 725c41aa3ceSMax Schwarz return ret; 726c41aa3ceSMax Schwarz } 727c41aa3ceSMax Schwarz 728c41aa3ceSMax Schwarz ret = i2c_add_adapter(&i2c->adap); 729c41aa3ceSMax Schwarz if (ret < 0) { 730c41aa3ceSMax Schwarz dev_err(&pdev->dev, "Could not register adapter\n"); 731c41aa3ceSMax Schwarz goto err_clk; 732c41aa3ceSMax Schwarz } 733c41aa3ceSMax Schwarz 734c41aa3ceSMax Schwarz dev_info(&pdev->dev, "Initialized RK3xxx I2C bus at %p\n", i2c->regs); 735c41aa3ceSMax Schwarz 736c41aa3ceSMax Schwarz return 0; 737c41aa3ceSMax Schwarz 738c41aa3ceSMax Schwarz err_clk: 739c41aa3ceSMax Schwarz clk_unprepare(i2c->clk); 740c41aa3ceSMax Schwarz return ret; 741c41aa3ceSMax Schwarz } 742c41aa3ceSMax Schwarz 743c41aa3ceSMax Schwarz static int rk3x_i2c_remove(struct platform_device *pdev) 744c41aa3ceSMax Schwarz { 745c41aa3ceSMax Schwarz struct rk3x_i2c *i2c = platform_get_drvdata(pdev); 746c41aa3ceSMax Schwarz 747c41aa3ceSMax Schwarz i2c_del_adapter(&i2c->adap); 748c41aa3ceSMax Schwarz clk_unprepare(i2c->clk); 749c41aa3ceSMax Schwarz 750c41aa3ceSMax Schwarz return 0; 751c41aa3ceSMax Schwarz } 752c41aa3ceSMax Schwarz 753c41aa3ceSMax Schwarz static struct platform_driver rk3x_i2c_driver = { 754c41aa3ceSMax Schwarz .probe = rk3x_i2c_probe, 755c41aa3ceSMax Schwarz .remove = rk3x_i2c_remove, 756c41aa3ceSMax Schwarz .driver = { 757c41aa3ceSMax Schwarz .owner = THIS_MODULE, 758c41aa3ceSMax Schwarz .name = "rk3x-i2c", 759c41aa3ceSMax Schwarz .of_match_table = rk3x_i2c_match, 760c41aa3ceSMax Schwarz }, 761c41aa3ceSMax Schwarz }; 762c41aa3ceSMax Schwarz 763c41aa3ceSMax Schwarz module_platform_driver(rk3x_i2c_driver); 764c41aa3ceSMax Schwarz 765c41aa3ceSMax Schwarz MODULE_DESCRIPTION("Rockchip RK3xxx I2C Bus driver"); 766c41aa3ceSMax Schwarz MODULE_AUTHOR("Max Schwarz <max.schwarz@online.de>"); 767c41aa3ceSMax Schwarz MODULE_LICENSE("GPL v2"); 768