mirror of https://gitee.com/openkylin/linux.git
i2c: omap: re-factor receive/transmit data loop
re-factor the common parts to a separate function, so that code is easier to read and understand. No functional changes. Signed-off-by: Felipe Balbi <balbi@ti.com> Signed-off-by: Shubhrajyoti D <shubhrajyoti@ti.com> Signed-off-by: Wolfram Sang <w.sang@pengutronix.de>
This commit is contained in:
parent
4151e74177
commit
3312d25e1a
|
@ -752,12 +752,81 @@ static int errata_omap3_i462(struct omap_i2c_dev *dev)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void omap_i2c_receive_data(struct omap_i2c_dev *dev, u8 num_bytes,
|
||||||
|
bool is_rdr)
|
||||||
|
{
|
||||||
|
u16 w;
|
||||||
|
|
||||||
|
while (num_bytes--) {
|
||||||
|
if (!dev->buf_len) {
|
||||||
|
dev_err(dev->dev, "%s without data",
|
||||||
|
is_rdr ? "RDR" : "RRDY");
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
w = omap_i2c_read_reg(dev, OMAP_I2C_DATA_REG);
|
||||||
|
*dev->buf++ = w;
|
||||||
|
dev->buf_len--;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Data reg in 2430, omap3 and
|
||||||
|
* omap4 is 8 bit wide
|
||||||
|
*/
|
||||||
|
if (dev->flags & OMAP_I2C_FLAG_16BIT_DATA_REG) {
|
||||||
|
if (dev->buf_len) {
|
||||||
|
*dev->buf++ = w >> 8;
|
||||||
|
dev->buf_len--;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static int omap_i2c_transmit_data(struct omap_i2c_dev *dev, u8 num_bytes,
|
||||||
|
bool is_xdr)
|
||||||
|
{
|
||||||
|
u16 w;
|
||||||
|
|
||||||
|
while (num_bytes--) {
|
||||||
|
if (!dev->buf_len) {
|
||||||
|
dev_err(dev->dev, "%s without data",
|
||||||
|
is_xdr ? "XDR" : "XRDY");
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
w = *dev->buf++;
|
||||||
|
dev->buf_len--;
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Data reg in 2430, omap3 and
|
||||||
|
* omap4 is 8 bit wide
|
||||||
|
*/
|
||||||
|
if (dev->flags & OMAP_I2C_FLAG_16BIT_DATA_REG) {
|
||||||
|
if (dev->buf_len) {
|
||||||
|
w |= *dev->buf++ << 8;
|
||||||
|
dev->buf_len--;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (dev->errata & I2C_OMAP_ERRATA_I462) {
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
ret = errata_omap3_i462(dev);
|
||||||
|
if (ret < 0)
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
omap_i2c_write_reg(dev, OMAP_I2C_DATA_REG, w);
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static irqreturn_t
|
static irqreturn_t
|
||||||
omap_i2c_isr(int this_irq, void *dev_id)
|
omap_i2c_isr(int this_irq, void *dev_id)
|
||||||
{
|
{
|
||||||
struct omap_i2c_dev *dev = dev_id;
|
struct omap_i2c_dev *dev = dev_id;
|
||||||
u16 bits;
|
u16 bits;
|
||||||
u16 stat, w;
|
u16 stat;
|
||||||
int err, count = 0;
|
int err, count = 0;
|
||||||
|
|
||||||
if (pm_runtime_suspended(dev->dev))
|
if (pm_runtime_suspended(dev->dev))
|
||||||
|
@ -810,30 +879,7 @@ omap_i2c_isr(int this_irq, void *dev_id)
|
||||||
if (dev->fifo_size)
|
if (dev->fifo_size)
|
||||||
num_bytes = dev->buf_len;
|
num_bytes = dev->buf_len;
|
||||||
|
|
||||||
while (num_bytes--) {
|
omap_i2c_receive_data(dev, num_bytes, true);
|
||||||
if (!dev->buf_len) {
|
|
||||||
dev_err(dev->dev,
|
|
||||||
"RDR IRQ while no data"
|
|
||||||
" requested\n");
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
w = omap_i2c_read_reg(dev, OMAP_I2C_DATA_REG);
|
|
||||||
*dev->buf++ = w;
|
|
||||||
dev->buf_len--;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Data reg in 2430, omap3 and
|
|
||||||
* omap4 is 8 bit wide
|
|
||||||
*/
|
|
||||||
if (dev->flags &
|
|
||||||
OMAP_I2C_FLAG_16BIT_DATA_REG) {
|
|
||||||
if (dev->buf_len) {
|
|
||||||
*dev->buf++ = w >> 8;
|
|
||||||
dev->buf_len--;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if (dev->errata & I2C_OMAP_ERRATA_I207)
|
if (dev->errata & I2C_OMAP_ERRATA_I207)
|
||||||
i2c_omap_errata_i207(dev, stat);
|
i2c_omap_errata_i207(dev, stat);
|
||||||
|
@ -848,77 +894,22 @@ omap_i2c_isr(int this_irq, void *dev_id)
|
||||||
if (dev->fifo_size)
|
if (dev->fifo_size)
|
||||||
num_bytes = dev->fifo_size;
|
num_bytes = dev->fifo_size;
|
||||||
|
|
||||||
while (num_bytes--) {
|
omap_i2c_receive_data(dev, num_bytes, false);
|
||||||
if (!dev->buf_len) {
|
|
||||||
dev_err(dev->dev,
|
|
||||||
"RRDY IRQ while no data"
|
|
||||||
" requested\n");
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
w = omap_i2c_read_reg(dev, OMAP_I2C_DATA_REG);
|
|
||||||
*dev->buf++ = w;
|
|
||||||
dev->buf_len--;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Data reg in 2430, omap3 and
|
|
||||||
* omap4 is 8 bit wide
|
|
||||||
*/
|
|
||||||
if (dev->flags &
|
|
||||||
OMAP_I2C_FLAG_16BIT_DATA_REG) {
|
|
||||||
if (dev->buf_len) {
|
|
||||||
*dev->buf++ = w >> 8;
|
|
||||||
dev->buf_len--;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
omap_i2c_ack_stat(dev, OMAP_I2C_STAT_RRDY);
|
omap_i2c_ack_stat(dev, OMAP_I2C_STAT_RRDY);
|
||||||
continue;
|
continue;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (stat & OMAP_I2C_STAT_XDR) {
|
if (stat & OMAP_I2C_STAT_XDR) {
|
||||||
u8 num_bytes = 1;
|
u8 num_bytes = 1;
|
||||||
|
int ret;
|
||||||
|
|
||||||
if (dev->fifo_size)
|
if (dev->fifo_size)
|
||||||
num_bytes = dev->buf_len;
|
num_bytes = dev->buf_len;
|
||||||
|
|
||||||
while (num_bytes--) {
|
ret = omap_i2c_transmit_data(dev, num_bytes, true);
|
||||||
if (!dev->buf_len) {
|
stat = omap_i2c_read_reg(dev, OMAP_I2C_STAT_REG);
|
||||||
dev_err(dev->dev,
|
if (ret < 0)
|
||||||
"XDR IRQ while no "
|
goto complete;
|
||||||
"data to send\n");
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
w = *dev->buf++;
|
|
||||||
dev->buf_len--;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Data reg in 2430, omap3 and
|
|
||||||
* omap4 is 8 bit wide
|
|
||||||
*/
|
|
||||||
if (dev->flags &
|
|
||||||
OMAP_I2C_FLAG_16BIT_DATA_REG) {
|
|
||||||
if (dev->buf_len) {
|
|
||||||
w |= *dev->buf++ << 8;
|
|
||||||
dev->buf_len--;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if (dev->errata & I2C_OMAP_ERRATA_I462) {
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
ret = errata_omap3_i462(dev);
|
|
||||||
stat = omap_i2c_read_reg(dev,
|
|
||||||
OMAP_I2C_STAT_REG);
|
|
||||||
|
|
||||||
if (ret < 0)
|
|
||||||
goto complete;
|
|
||||||
}
|
|
||||||
|
|
||||||
omap_i2c_write_reg(dev, OMAP_I2C_DATA_REG, w);
|
|
||||||
}
|
|
||||||
|
|
||||||
omap_i2c_ack_stat(dev, OMAP_I2C_STAT_XDR);
|
omap_i2c_ack_stat(dev, OMAP_I2C_STAT_XDR);
|
||||||
continue;
|
continue;
|
||||||
|
@ -926,46 +917,15 @@ omap_i2c_isr(int this_irq, void *dev_id)
|
||||||
|
|
||||||
if (stat & OMAP_I2C_STAT_XRDY) {
|
if (stat & OMAP_I2C_STAT_XRDY) {
|
||||||
u8 num_bytes = 1;
|
u8 num_bytes = 1;
|
||||||
|
int ret;
|
||||||
|
|
||||||
if (dev->fifo_size)
|
if (dev->fifo_size)
|
||||||
num_bytes = dev->fifo_size;
|
num_bytes = dev->fifo_size;
|
||||||
|
|
||||||
while (num_bytes--) {
|
ret = omap_i2c_transmit_data(dev, num_bytes, false);
|
||||||
if (!dev->buf_len) {
|
stat = omap_i2c_read_reg(dev, OMAP_I2C_STAT_REG);
|
||||||
dev_err(dev->dev,
|
if (ret < 0)
|
||||||
"XRDY IRQ while no "
|
goto complete;
|
||||||
"data to send\n");
|
|
||||||
break;
|
|
||||||
}
|
|
||||||
|
|
||||||
w = *dev->buf++;
|
|
||||||
dev->buf_len--;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Data reg in 2430, omap3 and
|
|
||||||
* omap4 is 8 bit wide
|
|
||||||
*/
|
|
||||||
if (dev->flags &
|
|
||||||
OMAP_I2C_FLAG_16BIT_DATA_REG) {
|
|
||||||
if (dev->buf_len) {
|
|
||||||
w |= *dev->buf++ << 8;
|
|
||||||
dev->buf_len--;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
if (dev->errata & I2C_OMAP_ERRATA_I462) {
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
ret = errata_omap3_i462(dev);
|
|
||||||
stat = omap_i2c_read_reg(dev,
|
|
||||||
OMAP_I2C_STAT_REG);
|
|
||||||
|
|
||||||
if (ret < 0)
|
|
||||||
goto complete;
|
|
||||||
}
|
|
||||||
|
|
||||||
omap_i2c_write_reg(dev, OMAP_I2C_DATA_REG, w);
|
|
||||||
}
|
|
||||||
|
|
||||||
omap_i2c_ack_stat(dev, OMAP_I2C_STAT_XRDY);
|
omap_i2c_ack_stat(dev, OMAP_I2C_STAT_XRDY);
|
||||||
continue;
|
continue;
|
||||||
|
|
Loading…
Reference in New Issue