Lines Matching refs:i2c
74 irqreturn_t netup_i2c_interrupt(struct netup_i2c *i2c) in netup_i2c_interrupt() argument
80 spin_lock_irqsave(&i2c->lock, flags); in netup_i2c_interrupt()
81 reg = readw(&i2c->regs->twi_ctrl0_stat); in netup_i2c_interrupt()
82 writew(reg & ~TWI_IRQEN, &i2c->regs->twi_ctrl0_stat); in netup_i2c_interrupt()
83 dev_dbg(i2c->adap.dev.parent, in netup_i2c_interrupt()
86 dev_dbg(i2c->adap.dev.parent, in netup_i2c_interrupt()
88 i2c->state = STATE_DONE; in netup_i2c_interrupt()
92 dev_dbg(i2c->adap.dev.parent, in netup_i2c_interrupt()
94 i2c->state = STATE_ERROR; in netup_i2c_interrupt()
98 dev_dbg(i2c->adap.dev.parent, in netup_i2c_interrupt()
100 i2c->state = STATE_ERROR; in netup_i2c_interrupt()
104 tmp = readw(&i2c->regs->rx_fifo.stat_ctrl); in netup_i2c_interrupt()
105 writew(tmp & ~FIFO_IRQEN, &i2c->regs->rx_fifo.stat_ctrl); in netup_i2c_interrupt()
106 i2c->state = STATE_WANT_READ; in netup_i2c_interrupt()
107 dev_dbg(i2c->adap.dev.parent, in netup_i2c_interrupt()
112 tmp = readw(&i2c->regs->tx_fifo.stat_ctrl); in netup_i2c_interrupt()
113 writew(tmp & ~FIFO_IRQEN, &i2c->regs->tx_fifo.stat_ctrl); in netup_i2c_interrupt()
114 i2c->state = STATE_WANT_WRITE; in netup_i2c_interrupt()
115 dev_dbg(i2c->adap.dev.parent, in netup_i2c_interrupt()
119 dev_warn(&i2c->adap.dev, "%s(): not mine interrupt\n", __func__); in netup_i2c_interrupt()
122 spin_unlock_irqrestore(&i2c->lock, flags); in netup_i2c_interrupt()
124 wake_up(&i2c->wq); in netup_i2c_interrupt()
128 static void netup_i2c_reset(struct netup_i2c *i2c) in netup_i2c_reset() argument
130 dev_dbg(i2c->adap.dev.parent, "%s()\n", __func__); in netup_i2c_reset()
131 i2c->state = STATE_DONE; in netup_i2c_reset()
132 writew(TWI_SOFT_RESET, &i2c->regs->twi_addr_ctrl1); in netup_i2c_reset()
133 writew(TWI_CLKDIV, &i2c->regs->clkdiv); in netup_i2c_reset()
134 writew(FIFO_RESET, &i2c->regs->tx_fifo.stat_ctrl); in netup_i2c_reset()
135 writew(FIFO_RESET, &i2c->regs->rx_fifo.stat_ctrl); in netup_i2c_reset()
136 writew(0x800, &i2c->regs->tx_fifo.stat_ctrl); in netup_i2c_reset()
137 writew(0x800, &i2c->regs->rx_fifo.stat_ctrl); in netup_i2c_reset()
140 static void netup_i2c_fifo_tx(struct netup_i2c *i2c) in netup_i2c_fifo_tx() argument
144 (readw(&i2c->regs->tx_fifo.stat_ctrl) & 0x3f); in netup_i2c_fifo_tx()
145 u32 msg_length = i2c->msg->len - i2c->xmit_size; in netup_i2c_fifo_tx()
149 data = i2c->msg->buf[i2c->xmit_size++]; in netup_i2c_fifo_tx()
150 writeb(data, &i2c->regs->tx_fifo.data8); in netup_i2c_fifo_tx()
151 dev_dbg(i2c->adap.dev.parent, in netup_i2c_fifo_tx()
154 if (i2c->xmit_size < i2c->msg->len) { in netup_i2c_fifo_tx()
155 dev_dbg(i2c->adap.dev.parent, in netup_i2c_fifo_tx()
157 writew(readw(&i2c->regs->tx_fifo.stat_ctrl) | FIFO_IRQEN, in netup_i2c_fifo_tx()
158 &i2c->regs->tx_fifo.stat_ctrl); in netup_i2c_fifo_tx()
162 static void netup_i2c_fifo_rx(struct netup_i2c *i2c) in netup_i2c_fifo_rx() argument
165 u32 fifo_size = readw(&i2c->regs->rx_fifo.stat_ctrl) & 0x3f; in netup_i2c_fifo_rx()
167 dev_dbg(i2c->adap.dev.parent, in netup_i2c_fifo_rx()
170 data = readb(&i2c->regs->rx_fifo.data8); in netup_i2c_fifo_rx()
171 if ((i2c->msg->flags & I2C_M_RD) != 0 && in netup_i2c_fifo_rx()
172 i2c->xmit_size < i2c->msg->len) { in netup_i2c_fifo_rx()
173 i2c->msg->buf[i2c->xmit_size++] = data; in netup_i2c_fifo_rx()
174 dev_dbg(i2c->adap.dev.parent, in netup_i2c_fifo_rx()
178 if (i2c->xmit_size < i2c->msg->len) { in netup_i2c_fifo_rx()
179 dev_dbg(i2c->adap.dev.parent, in netup_i2c_fifo_rx()
181 writew(readw(&i2c->regs->rx_fifo.stat_ctrl) | FIFO_IRQEN, in netup_i2c_fifo_rx()
182 &i2c->regs->rx_fifo.stat_ctrl); in netup_i2c_fifo_rx()
186 static void netup_i2c_start_xfer(struct netup_i2c *i2c) in netup_i2c_start_xfer() argument
188 u16 rdflag = ((i2c->msg->flags & I2C_M_RD) ? 1 : 0); in netup_i2c_start_xfer()
189 u16 reg = readw(&i2c->regs->twi_ctrl0_stat); in netup_i2c_start_xfer()
191 writew(TWI_IRQEN | reg, &i2c->regs->twi_ctrl0_stat); in netup_i2c_start_xfer()
192 writew(i2c->msg->len, &i2c->regs->length); in netup_i2c_start_xfer()
193 writew(TWI_TRANSFER | (i2c->msg->addr << 1) | rdflag, in netup_i2c_start_xfer()
194 &i2c->regs->twi_addr_ctrl1); in netup_i2c_start_xfer()
195 dev_dbg(i2c->adap.dev.parent, in netup_i2c_start_xfer()
197 __func__, readw(&i2c->regs->length), in netup_i2c_start_xfer()
198 readw(&i2c->regs->twi_addr_ctrl1), in netup_i2c_start_xfer()
199 readw(&i2c->regs->twi_ctrl0_stat)); in netup_i2c_start_xfer()
200 i2c->state = STATE_WAIT; in netup_i2c_start_xfer()
201 i2c->xmit_size = 0; in netup_i2c_start_xfer()
203 netup_i2c_fifo_tx(i2c); in netup_i2c_start_xfer()
205 writew(FIFO_IRQEN | readw(&i2c->regs->rx_fifo.stat_ctrl), in netup_i2c_start_xfer()
206 &i2c->regs->rx_fifo.stat_ctrl); in netup_i2c_start_xfer()
214 struct netup_i2c *i2c = i2c_get_adapdata(adap); in netup_i2c_xfer() local
218 dev_dbg(i2c->adap.dev.parent, in netup_i2c_xfer()
222 spin_lock_irqsave(&i2c->lock, flags); in netup_i2c_xfer()
223 if (i2c->state != STATE_DONE) { in netup_i2c_xfer()
224 dev_dbg(i2c->adap.dev.parent, in netup_i2c_xfer()
226 __func__, i2c->state); in netup_i2c_xfer()
227 netup_i2c_reset(i2c); in netup_i2c_xfer()
229 dev_dbg(i2c->adap.dev.parent, "%s() num %d\n", __func__, num); in netup_i2c_xfer()
231 i2c->msg = &msgs[i]; in netup_i2c_xfer()
232 netup_i2c_start_xfer(i2c); in netup_i2c_xfer()
235 spin_unlock_irqrestore(&i2c->lock, flags); in netup_i2c_xfer()
236 if (wait_event_timeout(i2c->wq, in netup_i2c_xfer()
237 i2c->state != STATE_WAIT, in netup_i2c_xfer()
239 spin_lock_irqsave(&i2c->lock, flags); in netup_i2c_xfer()
240 switch (i2c->state) { in netup_i2c_xfer()
242 netup_i2c_fifo_rx(i2c); in netup_i2c_xfer()
245 netup_i2c_fifo_tx(i2c); in netup_i2c_xfer()
248 if ((i2c->msg->flags & I2C_M_RD) != 0 && in netup_i2c_xfer()
249 i2c->xmit_size != i2c->msg->len) in netup_i2c_xfer()
250 netup_i2c_fifo_rx(i2c); in netup_i2c_xfer()
251 dev_dbg(i2c->adap.dev.parent, in netup_i2c_xfer()
258 dev_dbg(i2c->adap.dev.parent, in netup_i2c_xfer()
263 dev_dbg(i2c->adap.dev.parent, in netup_i2c_xfer()
265 __func__, i2c->state); in netup_i2c_xfer()
270 i2c->state = STATE_WAIT; in netup_i2c_xfer()
272 &i2c->regs->twi_ctrl0_stat); in netup_i2c_xfer()
274 &i2c->regs->twi_ctrl0_stat); in netup_i2c_xfer()
276 spin_unlock_irqrestore(&i2c->lock, flags); in netup_i2c_xfer()
278 spin_lock_irqsave(&i2c->lock, flags); in netup_i2c_xfer()
279 dev_dbg(i2c->adap.dev.parent, in netup_i2c_xfer()
284 spin_lock_irqsave(&i2c->lock, flags); in netup_i2c_xfer()
288 spin_unlock_irqrestore(&i2c->lock, flags); in netup_i2c_xfer()
289 dev_dbg(i2c->adap.dev.parent, "%s(): result %d\n", __func__, res); in netup_i2c_xfer()
313 struct netup_i2c *i2c; in netup_i2c_init() local
320 i2c = &ndev->i2c[bus_num]; in netup_i2c_init()
321 spin_lock_init(&i2c->lock); in netup_i2c_init()
322 init_waitqueue_head(&i2c->wq); in netup_i2c_init()
323 i2c->regs = (struct netup_i2c_regs __iomem *)(ndev->bmmio0 + in netup_i2c_init()
325 netup_i2c_reset(i2c); in netup_i2c_init()
326 i2c->adap = netup_i2c_adapter; in netup_i2c_init()
327 i2c->adap.dev.parent = &ndev->pci_dev->dev; in netup_i2c_init()
328 i2c_set_adapdata(&i2c->adap, i2c); in netup_i2c_init()
329 ret = i2c_add_adapter(&i2c->adap); in netup_i2c_init()
343 struct netup_i2c *i2c; in netup_i2c_remove() local
350 i2c = &ndev->i2c[bus_num]; in netup_i2c_remove()
351 netup_i2c_reset(i2c); in netup_i2c_remove()
353 i2c_del_adapter(&i2c->adap); in netup_i2c_remove()