|
@@ -5,7 +5,6 @@
|
|
#include <linux/i2c.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/i2c-smbus.h>
|
|
#include <linux/i2c-smbus.h>
|
|
#include <linux/io.h>
|
|
#include <linux/io.h>
|
|
-#include <linux/iopoll.h>
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/pci.h>
|
|
#include <linux/pci.h>
|
|
|
|
|
|
@@ -145,9 +144,9 @@ static inline void octeon_i2c_reg_write(struct octeon_i2c *i2c, u64 eop_reg, u8
|
|
u64 tmp;
|
|
u64 tmp;
|
|
|
|
|
|
__raw_writeq(SW_TWSI_V | eop_reg | data, i2c->twsi_base + SW_TWSI(i2c));
|
|
__raw_writeq(SW_TWSI_V | eop_reg | data, i2c->twsi_base + SW_TWSI(i2c));
|
|
-
|
|
|
|
- readq_poll_timeout(i2c->twsi_base + SW_TWSI(i2c), tmp, tmp & SW_TWSI_V,
|
|
|
|
- I2C_OCTEON_EVENT_WAIT, i2c->adap.timeout);
|
|
|
|
|
|
+ do {
|
|
|
|
+ tmp = __raw_readq(i2c->twsi_base + SW_TWSI(i2c));
|
|
|
|
+ } while ((tmp & SW_TWSI_V) != 0);
|
|
}
|
|
}
|
|
|
|
|
|
#define octeon_i2c_ctl_write(i2c, val) \
|
|
#define octeon_i2c_ctl_write(i2c, val) \
|
|
@@ -164,28 +163,24 @@ static inline void octeon_i2c_reg_write(struct octeon_i2c *i2c, u64 eop_reg, u8
|
|
*
|
|
*
|
|
* The I2C core registers are accessed indirectly via the SW_TWSI CSR.
|
|
* The I2C core registers are accessed indirectly via the SW_TWSI CSR.
|
|
*/
|
|
*/
|
|
-static inline int octeon_i2c_reg_read(struct octeon_i2c *i2c, u64 eop_reg,
|
|
|
|
- int *error)
|
|
|
|
|
|
+static inline u8 octeon_i2c_reg_read(struct octeon_i2c *i2c, u64 eop_reg)
|
|
{
|
|
{
|
|
u64 tmp;
|
|
u64 tmp;
|
|
- int ret;
|
|
|
|
|
|
|
|
__raw_writeq(SW_TWSI_V | eop_reg | SW_TWSI_R, i2c->twsi_base + SW_TWSI(i2c));
|
|
__raw_writeq(SW_TWSI_V | eop_reg | SW_TWSI_R, i2c->twsi_base + SW_TWSI(i2c));
|
|
|
|
+ do {
|
|
|
|
+ tmp = __raw_readq(i2c->twsi_base + SW_TWSI(i2c));
|
|
|
|
+ } while ((tmp & SW_TWSI_V) != 0);
|
|
|
|
|
|
- ret = readq_poll_timeout(i2c->twsi_base + SW_TWSI(i2c), tmp,
|
|
|
|
- tmp & SW_TWSI_V, I2C_OCTEON_EVENT_WAIT,
|
|
|
|
- i2c->adap.timeout);
|
|
|
|
- if (error)
|
|
|
|
- *error = ret;
|
|
|
|
return tmp & 0xFF;
|
|
return tmp & 0xFF;
|
|
}
|
|
}
|
|
|
|
|
|
#define octeon_i2c_ctl_read(i2c) \
|
|
#define octeon_i2c_ctl_read(i2c) \
|
|
- octeon_i2c_reg_read(i2c, SW_TWSI_EOP_TWSI_CTL, NULL)
|
|
|
|
-#define octeon_i2c_data_read(i2c, error) \
|
|
|
|
- octeon_i2c_reg_read(i2c, SW_TWSI_EOP_TWSI_DATA, error)
|
|
|
|
|
|
+ octeon_i2c_reg_read(i2c, SW_TWSI_EOP_TWSI_CTL)
|
|
|
|
+#define octeon_i2c_data_read(i2c) \
|
|
|
|
+ octeon_i2c_reg_read(i2c, SW_TWSI_EOP_TWSI_DATA)
|
|
#define octeon_i2c_stat_read(i2c) \
|
|
#define octeon_i2c_stat_read(i2c) \
|
|
- octeon_i2c_reg_read(i2c, SW_TWSI_EOP_TWSI_STAT, NULL)
|
|
|
|
|
|
+ octeon_i2c_reg_read(i2c, SW_TWSI_EOP_TWSI_STAT)
|
|
|
|
|
|
/**
|
|
/**
|
|
* octeon_i2c_read_int - read the TWSI_INT register
|
|
* octeon_i2c_read_int - read the TWSI_INT register
|