Skip to content

cloud-kernel
cloud-kernel

openanolis / cloud-kernel
1 年多 前同步成功

通知 160
Star 36
Fork 7
cloud-kernel
cloud-kernel
提交 aa3d0209 编写于 作者: B Bryan Wu 提交者： Jean Delvare
浏览文件
操作

i2c-bfin-twi: Add platform_resource interface to support multi-port TWI controllers 

 - Dynamic alloc the resource of TWI driver data according to board information
 - TWI register read/write accessor based on dynamic regs_base
 - Support TWI0/TWI1 for BF54x
Signed-off-by: NBryan Wu <cooloney@kernel.org>
Signed-off-by: NJean Delvare <khali@linux-fr.org>
上级 4dd39bb1
显示空白变更内容
内联 并排
Showing with 177 addition and 108 deletion
drivers/i2c/busses/Kconfig
浏览文件 @ aa3d0209
...@@ -100,7 +100,7 @@ config I2C_AU1550 ...@@ -100,7 +100,7 @@ config I2C_AU1550
config I2C_BLACKFIN_TWI config I2C_BLACKFIN_TWI
tristate "Blackfin TWI I2C support" tristate "Blackfin TWI I2C support"
depends on BF534 || BF536 || BF537 depends on BF534 || BF536 || BF537 || BF54x
help help
This is the TWI I2C device driver for Blackfin 534/536/537/54x. This is the TWI I2C device driver for Blackfin 534/536/537/54x.
This driver can also be built as a module. If so, the module This driver can also be built as a module. If so, the module
......
drivers/i2c/busses/i2c-bfin-twi.c
浏览文件 @ aa3d0209
...@@ -62,43 +62,66 @@ struct bfin_twi_iface { ...@@ -62,43 +62,66 @@ struct bfin_twi_iface {
struct i2c_msg *pmsg; struct i2c_msg *pmsg;
int msg_num; int msg_num;
int cur_msg; int cur_msg;
void __iomem *regs_base;
}; };
static struct bfin_twi_iface twi_iface;
#define DEFINE_TWI_REG(reg, off) \
static inline u16 read_##reg(struct bfin_twi_iface *iface) \
{ return bfin_read16(iface->regs_base + (off)); } \
static inline void write_##reg(struct bfin_twi_iface *iface, u16 v) \
{ bfin_write16(iface->regs_base + (off), v); }
DEFINE_TWI_REG(CLKDIV, 0x00)
DEFINE_TWI_REG(CONTROL, 0x04)
DEFINE_TWI_REG(SLAVE_CTL, 0x08)
DEFINE_TWI_REG(SLAVE_STAT, 0x0C)
DEFINE_TWI_REG(SLAVE_ADDR, 0x10)
DEFINE_TWI_REG(MASTER_CTL, 0x14)
DEFINE_TWI_REG(MASTER_STAT, 0x18)
DEFINE_TWI_REG(MASTER_ADDR, 0x1C)
DEFINE_TWI_REG(INT_STAT, 0x20)
DEFINE_TWI_REG(INT_MASK, 0x24)
DEFINE_TWI_REG(FIFO_CTL, 0x28)
DEFINE_TWI_REG(FIFO_STAT, 0x2C)
DEFINE_TWI_REG(XMT_DATA8, 0x80)
DEFINE_TWI_REG(XMT_DATA16, 0x84)
DEFINE_TWI_REG(RCV_DATA8, 0x88)
DEFINE_TWI_REG(RCV_DATA16, 0x8C)
static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface) static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface)
{ {
unsigned short twi_int_status = bfin_read_TWI_INT_STAT(); unsigned short twi_int_status = read_INT_STAT(iface);
unsigned short mast_stat = bfin_read_TWI_MASTER_STAT(); unsigned short mast_stat = read_MASTER_STAT(iface);
if (twi_int_status & XMTSERV) { if (twi_int_status & XMTSERV) {
/* Transmit next data */ /* Transmit next data */
if (iface->writeNum > 0) { if (iface->writeNum > 0) {
bfin_write_TWI_XMT_DATA8(*(iface->transPtr++)); write_XMT_DATA8(iface, *(iface->transPtr++));
iface->writeNum--; iface->writeNum--;
} }
/* start receive immediately after complete sending in /* start receive immediately after complete sending in
* combine mode. * combine mode.
*/ */
else if (iface->cur_mode == TWI_I2C_MODE_COMBINED) else if (iface->cur_mode == TWI_I2C_MODE_COMBINED)
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() write_MASTER_CTL(iface,
| MDIR | RSTART); read_MASTER_CTL(iface) | MDIR | RSTART);
else if (iface->manual_stop) else if (iface->manual_stop)
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() write_MASTER_CTL(iface,
| STOP); read_MASTER_CTL(iface) | STOP);
else if (iface->cur_mode == TWI_I2C_MODE_REPEAT && else if (iface->cur_mode == TWI_I2C_MODE_REPEAT &&
iface->cur_msg+1 < iface->msg_num) iface->cur_msg+1 < iface->msg_num)
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() write_MASTER_CTL(iface,
| RSTART); read_MASTER_CTL(iface) | RSTART);
SSYNC(); SSYNC();
/* Clear status */ /* Clear status */
bfin_write_TWI_INT_STAT(XMTSERV); write_INT_STAT(iface, XMTSERV);
SSYNC(); SSYNC();
} }
if (twi_int_status & RCVSERV) { if (twi_int_status & RCVSERV) {
if (iface->readNum > 0) { if (iface->readNum > 0) {
/* Receive next data */ /* Receive next data */
*(iface->transPtr) = bfin_read_TWI_RCV_DATA8(); *(iface->transPtr) = read_RCV_DATA8(iface);
if (iface->cur_mode == TWI_I2C_MODE_COMBINED) { if (iface->cur_mode == TWI_I2C_MODE_COMBINED) {
/* Change combine mode into sub mode after /* Change combine mode into sub mode after
* read first data. * read first data.
...@@ -113,33 +136,33 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface) ...@@ -113,33 +136,33 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface)
iface->transPtr++; iface->transPtr++;
iface->readNum--; iface->readNum--;
} else if (iface->manual_stop) { } else if (iface->manual_stop) {
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() write_MASTER_CTL(iface,
| STOP); read_MASTER_CTL(iface) | STOP);
SSYNC(); SSYNC();
} else if (iface->cur_mode == TWI_I2C_MODE_REPEAT && } else if (iface->cur_mode == TWI_I2C_MODE_REPEAT &&
iface->cur_msg+1 < iface->msg_num) { iface->cur_msg+1 < iface->msg_num) {
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() write_MASTER_CTL(iface,
| RSTART); read_MASTER_CTL(iface) | RSTART);
SSYNC(); SSYNC();
} }
/* Clear interrupt source */ /* Clear interrupt source */
bfin_write_TWI_INT_STAT(RCVSERV); write_INT_STAT(iface, RCVSERV);
SSYNC(); SSYNC();
} }
if (twi_int_status & MERR) { if (twi_int_status & MERR) {
bfin_write_TWI_INT_STAT(MERR); write_INT_STAT(iface, MERR);
bfin_write_TWI_INT_MASK(0); write_INT_MASK(iface, 0);
bfin_write_TWI_MASTER_STAT(0x3e); write_MASTER_STAT(iface, 0x3e);
bfin_write_TWI_MASTER_CTL(0); write_MASTER_CTL(iface, 0);
SSYNC(); SSYNC();
iface->result = -EIO; iface->result = -EIO;
/* if both err and complete int stats are set, return proper /* if both err and complete int stats are set, return proper
* results. * results.
*/ */
if (twi_int_status & MCOMP) { if (twi_int_status & MCOMP) {
bfin_write_TWI_INT_STAT(MCOMP); write_INT_STAT(iface, MCOMP);
bfin_write_TWI_INT_MASK(0); write_INT_MASK(iface, 0);
bfin_write_TWI_MASTER_CTL(0); write_MASTER_CTL(iface, 0);
SSYNC(); SSYNC();
/* If it is a quick transfer, only address bug no data, /* If it is a quick transfer, only address bug no data,
* not an err, return 1. * not an err, return 1.
...@@ -156,7 +179,7 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface) ...@@ -156,7 +179,7 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface)
return; return;
} }
if (twi_int_status & MCOMP) { if (twi_int_status & MCOMP) {
bfin_write_TWI_INT_STAT(MCOMP); write_INT_STAT(iface, MCOMP);
SSYNC(); SSYNC();
if (iface->cur_mode == TWI_I2C_MODE_COMBINED) { if (iface->cur_mode == TWI_I2C_MODE_COMBINED) {
if (iface->readNum == 0) { if (iface->readNum == 0) {
...@@ -165,23 +188,22 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface) ...@@ -165,23 +188,22 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface)
*/ */
iface->readNum = 1; iface->readNum = 1;
iface->manual_stop = 1; iface->manual_stop = 1;
bfin_write_TWI_MASTER_CTL( write_MASTER_CTL(iface,
bfin_read_TWI_MASTER_CTL() read_MASTER_CTL(iface) | (0xff << 6));
| (0xff << 6));
} else { } else {
/* set the readd number in other /* set the readd number in other
* combine mode. * combine mode.
*/ */
bfin_write_TWI_MASTER_CTL( write_MASTER_CTL(iface,
(bfin_read_TWI_MASTER_CTL() & (read_MASTER_CTL(iface) &
(~(0xff << 6))) | (~(0xff << 6))) |
( iface->readNum << 6)); (iface->readNum << 6));
} }
/* remove restart bit and enable master receive */ /* remove restart bit and enable master receive */
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() & write_MASTER_CTL(iface,
~RSTART); read_MASTER_CTL(iface) & ~RSTART);
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() | write_MASTER_CTL(iface,
MEN | MDIR); read_MASTER_CTL(iface) | MEN | MDIR);
SSYNC(); SSYNC();
} else if (iface->cur_mode == TWI_I2C_MODE_REPEAT && } else if (iface->cur_mode == TWI_I2C_MODE_REPEAT &&
iface->cur_msg+1 < iface->msg_num) { iface->cur_msg+1 < iface->msg_num) {
...@@ -190,7 +212,7 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface) ...@@ -190,7 +212,7 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface)
iface->writeNum = iface->readNum = iface->writeNum = iface->readNum =
iface->pmsg[iface->cur_msg].len; iface->pmsg[iface->cur_msg].len;
/* Set Transmit device address */ /* Set Transmit device address */
bfin_write_TWI_MASTER_ADDR( write_MASTER_ADDR(iface,
iface->pmsg[iface->cur_msg].addr); iface->pmsg[iface->cur_msg].addr);
if (iface->pmsg[iface->cur_msg].flags & I2C_M_RD) if (iface->pmsg[iface->cur_msg].flags & I2C_M_RD)
iface->read_write = I2C_SMBUS_READ; iface->read_write = I2C_SMBUS_READ;
...@@ -198,7 +220,7 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface) ...@@ -198,7 +220,7 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface)
iface->read_write = I2C_SMBUS_WRITE; iface->read_write = I2C_SMBUS_WRITE;
/* Transmit first data */ /* Transmit first data */
if (iface->writeNum > 0) { if (iface->writeNum > 0) {
bfin_write_TWI_XMT_DATA8( write_XMT_DATA8(iface,
*(iface->transPtr++)); *(iface->transPtr++));
iface->writeNum--; iface->writeNum--;
SSYNC(); SSYNC();
...@@ -206,23 +228,23 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface) ...@@ -206,23 +228,23 @@ static void bfin_twi_handle_interrupt(struct bfin_twi_iface *iface)
} }
if (iface->pmsg[iface->cur_msg].len <= 255) if (iface->pmsg[iface->cur_msg].len <= 255)
bfin_write_TWI_MASTER_CTL( write_MASTER_CTL(iface,
iface->pmsg[iface->cur_msg].len << 6); iface->pmsg[iface->cur_msg].len << 6);
else { else {
bfin_write_TWI_MASTER_CTL(0xff << 6); write_MASTER_CTL(iface, 0xff << 6);
iface->manual_stop = 1; iface->manual_stop = 1;
} }
/* remove restart bit and enable master receive */ /* remove restart bit and enable master receive */
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() & write_MASTER_CTL(iface,
~RSTART); read_MASTER_CTL(iface) & ~RSTART);
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() | write_MASTER_CTL(iface, read_MASTER_CTL(iface) |
MEN | ((iface->read_write == I2C_SMBUS_READ) ? MEN | ((iface->read_write == I2C_SMBUS_READ) ?
MDIR : 0)); MDIR : 0));
SSYNC(); SSYNC();
} else { } else {
iface->result = 1; iface->result = 1;
bfin_write_TWI_INT_MASK(0); write_INT_MASK(iface, 0);
bfin_write_TWI_MASTER_CTL(0); write_MASTER_CTL(iface, 0);
SSYNC(); SSYNC();
complete(&iface->complete); complete(&iface->complete);
} }
...@@ -272,12 +294,11 @@ static int bfin_twi_master_xfer(struct i2c_adapter *adap, ...@@ -272,12 +294,11 @@ static int bfin_twi_master_xfer(struct i2c_adapter *adap,
struct i2c_msg *pmsg; struct i2c_msg *pmsg;
int rc = 0; int rc = 0;
if (!(bfin_read_TWI_CONTROL() & TWI_ENA)) if (!(read_CONTROL(iface) & TWI_ENA))
return -ENXIO; return -ENXIO;
while (bfin_read_TWI_MASTER_STAT() & BUSBUSY) { while (read_MASTER_STAT(iface) & BUSBUSY)
yield(); yield();
}
iface->pmsg = msgs; iface->pmsg = msgs;
iface->msg_num = num; iface->msg_num = num;
...@@ -296,14 +317,14 @@ static int bfin_twi_master_xfer(struct i2c_adapter *adap, ...@@ -296,14 +317,14 @@ static int bfin_twi_master_xfer(struct i2c_adapter *adap,
iface->result = 0; iface->result = 0;
iface->timeout_count = 10; iface->timeout_count = 10;
/* Set Transmit device address */ /* Set Transmit device address */
bfin_write_TWI_MASTER_ADDR(pmsg->addr); write_MASTER_ADDR(iface, pmsg->addr);
/* FIFO Initiation. Data in FIFO should be /* FIFO Initiation. Data in FIFO should be
* discarded before start a new operation. * discarded before start a new operation.
*/ */
bfin_write_TWI_FIFO_CTL(0x3); write_FIFO_CTL(iface, 0x3);
SSYNC(); SSYNC();
bfin_write_TWI_FIFO_CTL(0); write_FIFO_CTL(iface, 0);
SSYNC(); SSYNC();
if (pmsg->flags & I2C_M_RD) if (pmsg->flags & I2C_M_RD)
...@@ -312,23 +333,23 @@ static int bfin_twi_master_xfer(struct i2c_adapter *adap, ...@@ -312,23 +333,23 @@ static int bfin_twi_master_xfer(struct i2c_adapter *adap,
iface->read_write = I2C_SMBUS_WRITE; iface->read_write = I2C_SMBUS_WRITE;
/* Transmit first data */ /* Transmit first data */
if (iface->writeNum > 0) { if (iface->writeNum > 0) {
bfin_write_TWI_XMT_DATA8(*(iface->transPtr++)); write_XMT_DATA8(iface, *(iface->transPtr++));
iface->writeNum--; iface->writeNum--;
SSYNC(); SSYNC();
} }
} }
/* clear int stat */ /* clear int stat */
bfin_write_TWI_INT_STAT(MERR | MCOMP | XMTSERV | RCVSERV); write_INT_STAT(iface, MERR | MCOMP | XMTSERV | RCVSERV);
/* Interrupt mask . Enable XMT, RCV interrupt */ /* Interrupt mask . Enable XMT, RCV interrupt */
bfin_write_TWI_INT_MASK(MCOMP | MERR | RCVSERV | XMTSERV); write_INT_MASK(iface, MCOMP | MERR | RCVSERV | XMTSERV);
SSYNC(); SSYNC();
if (pmsg->len <= 255) if (pmsg->len <= 255)
bfin_write_TWI_MASTER_CTL(pmsg->len << 6); write_MASTER_CTL(iface, pmsg->len << 6);
else { else {
bfin_write_TWI_MASTER_CTL(0xff << 6); write_MASTER_CTL(iface, 0xff << 6);
iface->manual_stop = 1; iface->manual_stop = 1;
} }
...@@ -336,7 +357,7 @@ static int bfin_twi_master_xfer(struct i2c_adapter *adap, ...@@ -336,7 +357,7 @@ static int bfin_twi_master_xfer(struct i2c_adapter *adap,
add_timer(&iface->timeout_timer); add_timer(&iface->timeout_timer);
/* Master enable */ /* Master enable */
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() | MEN | write_MASTER_CTL(iface, read_MASTER_CTL(iface) | MEN |
((iface->read_write == I2C_SMBUS_READ) ? MDIR : 0) | ((iface->read_write == I2C_SMBUS_READ) ? MDIR : 0) |
((CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ > 100) ? FAST : 0)); ((CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ > 100) ? FAST : 0));
SSYNC(); SSYNC();
...@@ -362,12 +383,11 @@ int bfin_twi_smbus_xfer(struct i2c_adapter *adap, u16 addr, ...@@ -362,12 +383,11 @@ int bfin_twi_smbus_xfer(struct i2c_adapter *adap, u16 addr,
struct bfin_twi_iface *iface = adap->algo_data; struct bfin_twi_iface *iface = adap->algo_data;
int rc = 0; int rc = 0;
if (!(bfin_read_TWI_CONTROL() & TWI_ENA)) if (!(read_CONTROL(iface) & TWI_ENA))
return -ENXIO; return -ENXIO;
while (bfin_read_TWI_MASTER_STAT() & BUSBUSY) { while (read_MASTER_STAT(iface) & BUSBUSY)
yield(); yield();
}
iface->writeNum = 0; iface->writeNum = 0;
iface->readNum = 0; iface->readNum = 0;
...@@ -439,15 +459,15 @@ int bfin_twi_smbus_xfer(struct i2c_adapter *adap, u16 addr, ...@@ -439,15 +459,15 @@ int bfin_twi_smbus_xfer(struct i2c_adapter *adap, u16 addr,
/* FIFO Initiation. Data in FIFO should be discarded before /* FIFO Initiation. Data in FIFO should be discarded before
* start a new operation. * start a new operation.
*/ */
bfin_write_TWI_FIFO_CTL(0x3); write_FIFO_CTL(iface, 0x3);
SSYNC(); SSYNC();
bfin_write_TWI_FIFO_CTL(0); write_FIFO_CTL(iface, 0);
/* clear int stat */ /* clear int stat */
bfin_write_TWI_INT_STAT(MERR|MCOMP|XMTSERV|RCVSERV); write_INT_STAT(iface, MERR | MCOMP | XMTSERV | RCVSERV);
/* Set Transmit device address */ /* Set Transmit device address */
bfin_write_TWI_MASTER_ADDR(addr); write_MASTER_ADDR(iface, addr);
SSYNC(); SSYNC();
iface->timeout_timer.expires = jiffies + POLL_TIMEOUT; iface->timeout_timer.expires = jiffies + POLL_TIMEOUT;
...@@ -455,60 +475,64 @@ int bfin_twi_smbus_xfer(struct i2c_adapter *adap, u16 addr, ...@@ -455,60 +475,64 @@ int bfin_twi_smbus_xfer(struct i2c_adapter *adap, u16 addr,
switch (iface->cur_mode) { switch (iface->cur_mode) {
case TWI_I2C_MODE_STANDARDSUB: case TWI_I2C_MODE_STANDARDSUB:
bfin_write_TWI_XMT_DATA8(iface->command); write_XMT_DATA8(iface, iface->command);
bfin_write_TWI_INT_MASK(MCOMP | MERR | write_INT_MASK(iface, MCOMP | MERR |
((iface->read_write == I2C_SMBUS_READ) ? ((iface->read_write == I2C_SMBUS_READ) ?
RCVSERV : XMTSERV)); RCVSERV : XMTSERV));
SSYNC(); SSYNC();
if (iface->writeNum + 1 <= 255) if (iface->writeNum + 1 <= 255)
bfin_write_TWI_MASTER_CTL((iface->writeNum + 1) << 6); write_MASTER_CTL(iface, (iface->writeNum + 1) << 6);
else { else {
bfin_write_TWI_MASTER_CTL(0xff << 6); write_MASTER_CTL(iface, 0xff << 6);
iface->manual_stop = 1; iface->manual_stop = 1;
} }
/* Master enable */ /* Master enable */
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() | MEN | write_MASTER_CTL(iface, read_MASTER_CTL(iface) | MEN |
((CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ>100) ? FAST : 0)); ((CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ>100) ? FAST : 0));
break; break;
case TWI_I2C_MODE_COMBINED: case TWI_I2C_MODE_COMBINED:
bfin_write_TWI_XMT_DATA8(iface->command); write_XMT_DATA8(iface, iface->command);
bfin_write_TWI_INT_MASK(MCOMP | MERR | RCVSERV | XMTSERV); write_INT_MASK(iface, MCOMP | MERR | RCVSERV | XMTSERV);
SSYNC(); SSYNC();
if (iface->writeNum > 0) if (iface->writeNum > 0)
bfin_write_TWI_MASTER_CTL((iface->writeNum + 1) << 6); write_MASTER_CTL(iface, (iface->writeNum + 1) << 6);
else else
bfin_write_TWI_MASTER_CTL(0x1 << 6); write_MASTER_CTL(iface, 0x1 << 6);
/* Master enable */ /* Master enable */
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() | MEN | write_MASTER_CTL(iface, read_MASTER_CTL(iface) | MEN |
((CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ>100) ? FAST : 0)); ((CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ>100) ? FAST : 0));
break; break;
default: default:
bfin_write_TWI_MASTER_CTL(0); write_MASTER_CTL(iface, 0);
if (size != I2C_SMBUS_QUICK) { if (size != I2C_SMBUS_QUICK) {
/* Don't access xmit data register when this is a /* Don't access xmit data register when this is a
* read operation. * read operation.
*/ */
if (iface->read_write != I2C_SMBUS_READ) { if (iface->read_write != I2C_SMBUS_READ) {
if (iface->writeNum > 0) { if (iface->writeNum > 0) {
bfin_write_TWI_XMT_DATA8(*(iface->transPtr++)); write_XMT_DATA8(iface,
*(iface->transPtr++));
if (iface->writeNum <= 255) if (iface->writeNum <= 255)
bfin_write_TWI_MASTER_CTL(iface->writeNum << 6); write_MASTER_CTL(iface,
iface->writeNum << 6);
else { else {
bfin_write_TWI_MASTER_CTL(0xff << 6); write_MASTER_CTL(iface,
0xff << 6);
iface->manual_stop = 1; iface->manual_stop = 1;
} }
iface->writeNum--; iface->writeNum--;
} else { } else {
bfin_write_TWI_XMT_DATA8(iface->command); write_XMT_DATA8(iface, iface->command);
bfin_write_TWI_MASTER_CTL(1 << 6); write_MASTER_CTL(iface, 1 << 6);
} }
} else { } else {
if (iface->readNum > 0 && iface->readNum <= 255) if (iface->readNum > 0 && iface->readNum <= 255)
bfin_write_TWI_MASTER_CTL(iface->readNum << 6); write_MASTER_CTL(iface,
iface->readNum << 6);
else if (iface->readNum > 255) { else if (iface->readNum > 255) {
bfin_write_TWI_MASTER_CTL(0xff << 6); write_MASTER_CTL(iface, 0xff << 6);
iface->manual_stop = 1; iface->manual_stop = 1;
} else { } else {
del_timer(&iface->timeout_timer); del_timer(&iface->timeout_timer);
...@@ -516,13 +540,13 @@ int bfin_twi_smbus_xfer(struct i2c_adapter *adap, u16 addr, ...@@ -516,13 +540,13 @@ int bfin_twi_smbus_xfer(struct i2c_adapter *adap, u16 addr,
} }
} }
} }
bfin_write_TWI_INT_MASK(MCOMP | MERR | write_INT_MASK(iface, MCOMP | MERR |
((iface->read_write == I2C_SMBUS_READ) ? ((iface->read_write == I2C_SMBUS_READ) ?
RCVSERV : XMTSERV)); RCVSERV : XMTSERV));
SSYNC(); SSYNC();
/* Master enable */ /* Master enable */
bfin_write_TWI_MASTER_CTL(bfin_read_TWI_MASTER_CTL() | MEN | write_MASTER_CTL(iface, read_MASTER_CTL(iface) | MEN |
((iface->read_write == I2C_SMBUS_READ) ? MDIR : 0) | ((iface->read_write == I2C_SMBUS_READ) ? MDIR : 0) |
((CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ > 100) ? FAST : 0)); ((CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ > 100) ? FAST : 0));
break; break;
...@@ -557,10 +581,10 @@ static struct i2c_algorithm bfin_twi_algorithm = { ...@@ -557,10 +581,10 @@ static struct i2c_algorithm bfin_twi_algorithm = {
static int i2c_bfin_twi_suspend(struct platform_device *dev, pm_message_t state) static int i2c_bfin_twi_suspend(struct platform_device *dev, pm_message_t state)
{ {
/* struct bfin_twi_iface *iface = platform_get_drvdata(dev);*/ struct bfin_twi_iface *iface = platform_get_drvdata(dev);
/* Disable TWI */ /* Disable TWI */
bfin_write_TWI_CONTROL(bfin_read_TWI_CONTROL() & ~TWI_ENA); write_CONTROL(iface, read_CONTROL(iface) & ~TWI_ENA);
SSYNC(); SSYNC();
return 0; return 0;
...@@ -568,24 +592,53 @@ static int i2c_bfin_twi_suspend(struct platform_device *dev, pm_message_t state) ...@@ -568,24 +592,53 @@ static int i2c_bfin_twi_suspend(struct platform_device *dev, pm_message_t state)
static int i2c_bfin_twi_resume(struct platform_device *dev) static int i2c_bfin_twi_resume(struct platform_device *dev)
{ {
/* struct bfin_twi_iface *iface = platform_get_drvdata(dev);*/ struct bfin_twi_iface *iface = platform_get_drvdata(dev);
/* Enable TWI */ /* Enable TWI */
bfin_write_TWI_CONTROL(bfin_read_TWI_CONTROL() | TWI_ENA); write_CONTROL(iface, read_CONTROL(iface) | TWI_ENA);
SSYNC(); SSYNC();
return 0; return 0;
} }
static int i2c_bfin_twi_probe(struct platform_device *dev) static int i2c_bfin_twi_probe(struct platform_device *pdev)
{ {
struct bfin_twi_iface *iface = &twi_iface; struct bfin_twi_iface *iface;
struct i2c_adapter *p_adap; struct i2c_adapter *p_adap;
struct resource *res;
int rc; int rc;
iface = kzalloc(sizeof(struct bfin_twi_iface), GFP_KERNEL);
if (!iface) {
dev_err(&pdev->dev, "Cannot allocate memory\n");
rc = -ENOMEM;
goto out_error_nomem;
}
spin_lock_init(&(iface->lock)); spin_lock_init(&(iface->lock));
init_completion(&(iface->complete)); init_completion(&(iface->complete));
iface->irq = IRQ_TWI;
/* Find and map our resources */
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
if (res == NULL) {
dev_err(&pdev->dev, "Cannot get IORESOURCE_MEM\n");
rc = -ENOENT;
goto out_error_get_res;
}
iface->regs_base = ioremap(res->start, res->end - res->start + 1);
if (iface->regs_base == NULL) {
dev_err(&pdev->dev, "Cannot map IO\n");
rc = -ENXIO;
goto out_error_ioremap;
}
iface->irq = platform_get_irq(pdev, 0);
if (iface->irq < 0) {
dev_err(&pdev->dev, "No IRQ specified\n");
rc = -ENOENT;
goto out_error_no_irq;
}
init_timer(&(iface->timeout_timer)); init_timer(&(iface->timeout_timer));
iface->timeout_timer.function = bfin_twi_timeout; iface->timeout_timer.function = bfin_twi_timeout;
...@@ -593,39 +646,55 @@ static int i2c_bfin_twi_probe(struct platform_device *dev) ...@@ -593,39 +646,55 @@ static int i2c_bfin_twi_probe(struct platform_device *dev)
p_adap = &iface->adap; p_adap = &iface->adap;
p_adap->id = I2C_HW_BLACKFIN; p_adap->id = I2C_HW_BLACKFIN;
p_adap->nr = dev->id; p_adap->nr = pdev->id;
strlcpy(p_adap->name, dev->name, sizeof(p_adap->name)); strlcpy(p_adap->name, pdev->name, sizeof(p_adap->name));
p_adap->algo = &bfin_twi_algorithm; p_adap->algo = &bfin_twi_algorithm;
p_adap->algo_data = iface; p_adap->algo_data = iface;
p_adap->class = I2C_CLASS_ALL; p_adap->class = I2C_CLASS_ALL;
p_adap->dev.parent = &dev->dev; p_adap->dev.parent = &pdev->dev;
rc = request_irq(iface->irq, bfin_twi_interrupt_entry, rc = request_irq(iface->irq, bfin_twi_interrupt_entry,
IRQF_DISABLED, dev->name, iface); IRQF_DISABLED, pdev->name, iface);
if (rc) { if (rc) {
dev_err(&(p_adap->dev), "i2c-bfin-twi: can't get IRQ %d !\n", dev_err(&pdev->dev, "Can't get IRQ %d !\n", iface->irq);
iface->irq); rc = -ENODEV;
return -ENODEV; goto out_error_req_irq;
} }
/* Set TWI internal clock as 10MHz */ /* Set TWI internal clock as 10MHz */
bfin_write_TWI_CONTROL(((get_sclk() / 1024 / 1024 + 5) / 10) & 0x7F); write_CONTROL(iface, ((get_sclk() / 1024 / 1024 + 5) / 10) & 0x7F);
/* Set Twi interface clock as specified */ /* Set Twi interface clock as specified */
bfin_write_TWI_CLKDIV((( 5*1024 / CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ ) write_CLKDIV(iface, ((5*1024 / CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ)
<< 8) | (( 5*1024 / CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ ) << 8) | ((5*1024 / CONFIG_I2C_BLACKFIN_TWI_CLK_KHZ)
& 0xFF)); & 0xFF));
/* Enable TWI */ /* Enable TWI */
bfin_write_TWI_CONTROL(bfin_read_TWI_CONTROL() | TWI_ENA); write_CONTROL(iface, read_CONTROL(iface) | TWI_ENA);
SSYNC(); SSYNC();
rc = i2c_add_numbered_adapter(p_adap); rc = i2c_add_numbered_adapter(p_adap);
if (rc < 0) if (rc < 0) {
free_irq(iface->irq, iface); dev_err(&pdev->dev, "Can't add i2c adapter!\n");
else goto out_error_add_adapter;
platform_set_drvdata(dev, iface); }
platform_set_drvdata(pdev, iface);
dev_info(&pdev->dev, "Blackfin I2C TWI controller, regs_base@%p\n",
iface->regs_base);
return 0;
out_error_add_adapter:
free_irq(iface->irq, iface);
out_error_req_irq:
out_error_no_irq:
iounmap(iface->regs_base);
out_error_ioremap:
out_error_get_res:
kfree(iface);
out_error_nomem:
return rc; return rc;
} }
...@@ -637,6 +706,8 @@ static int i2c_bfin_twi_remove(struct platform_device *pdev) ...@@ -637,6 +706,8 @@ static int i2c_bfin_twi_remove(struct platform_device *pdev)
i2c_del_adapter(&(iface->adap)); i2c_del_adapter(&(iface->adap));
free_irq(iface->irq, iface); free_irq(iface->irq, iface);
iounmap(iface->regs_base);
kfree(iface);
return 0; return 0;
} }
...@@ -654,8 +725,6 @@ static struct platform_driver i2c_bfin_twi_driver = { ...@@ -654,8 +725,6 @@ static struct platform_driver i2c_bfin_twi_driver = {
static int __init i2c_bfin_twi_init(void) static int __init i2c_bfin_twi_init(void)
{ {
pr_info("I2C: Blackfin I2C TWI driver\n");
return platform_driver_register(&i2c_bfin_twi_driver); return platform_driver_register(&i2c_bfin_twi_driver);
} }
......
Markdown is supported
0% 或 .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑！
想要评论请 注册 或