提交 beea494d 编写于 作者: R Russell King 提交者: Russell King

[ARM] Remove EEPROM slave emulation from i2c-pxa driver.

The i2c-pxa driver should not contain EEPROM slave-mode emulation;
this is something the platform should provide where required.  Remove
it.
Signed-off-by: NRussell King <rmk+kernel@arm.linux.org.uk>
上级 df58d035
......@@ -357,133 +357,6 @@ static void i2c_pxa_reset(struct pxa_i2c *i2c)
#ifdef CONFIG_I2C_PXA_SLAVE
/*
* I2C EEPROM emulation.
*/
static struct i2c_eeprom_emu eeprom = {
.size = I2C_EEPROM_EMU_SIZE,
.watch = LIST_HEAD_INIT(eeprom.watch),
};
struct i2c_eeprom_emu *i2c_pxa_get_eeprom(void)
{
return &eeprom;
}
int i2c_eeprom_emu_addwatcher(struct i2c_eeprom_emu *emu, void *data,
unsigned int addr, unsigned int size,
struct i2c_eeprom_emu_watcher *watcher)
{
struct i2c_eeprom_emu_watch *watch;
unsigned long flags;
if (addr + size > emu->size)
return -EINVAL;
watch = kmalloc(sizeof(struct i2c_eeprom_emu_watch), GFP_KERNEL);
if (watch) {
watch->start = addr;
watch->end = addr + size - 1;
watch->ops = watcher;
watch->data = data;
local_irq_save(flags);
list_add(&watch->node, &emu->watch);
local_irq_restore(flags);
}
return watch ? 0 : -ENOMEM;
}
void i2c_eeprom_emu_delwatcher(struct i2c_eeprom_emu *emu, void *data,
struct i2c_eeprom_emu_watcher *watcher)
{
struct i2c_eeprom_emu_watch *watch, *n;
unsigned long flags;
list_for_each_entry_safe(watch, n, &emu->watch, node) {
if (watch->ops == watcher && watch->data == data) {
local_irq_save(flags);
list_del(&watch->node);
local_irq_restore(flags);
kfree(watch);
}
}
}
static void i2c_eeprom_emu_event(void *ptr, i2c_slave_event_t event)
{
struct i2c_eeprom_emu *emu = ptr;
eedbg(3, "i2c_eeprom_emu_event: %d\n", event);
switch (event) {
case I2C_SLAVE_EVENT_START_WRITE:
emu->seen_start = 1;
eedbg(2, "i2c_eeprom: write initiated\n");
break;
case I2C_SLAVE_EVENT_START_READ:
emu->seen_start = 0;
eedbg(2, "i2c_eeprom: read initiated\n");
break;
case I2C_SLAVE_EVENT_STOP:
emu->seen_start = 0;
eedbg(2, "i2c_eeprom: received stop\n");
break;
default:
eedbg(0, "i2c_eeprom: unhandled event\n");
break;
}
}
static int i2c_eeprom_emu_read(void *ptr)
{
struct i2c_eeprom_emu *emu = ptr;
int ret;
ret = emu->bytes[emu->ptr];
emu->ptr = (emu->ptr + 1) % emu->size;
return ret;
}
static void i2c_eeprom_emu_write(void *ptr, unsigned int val)
{
struct i2c_eeprom_emu *emu = ptr;
struct i2c_eeprom_emu_watch *watch;
if (emu->seen_start != 0) {
eedbg(2, "i2c_eeprom_emu_write: setting ptr %02x\n", val);
emu->ptr = val;
emu->seen_start = 0;
return;
}
emu->bytes[emu->ptr] = val;
eedbg(1, "i2c_eeprom_emu_write: ptr=0x%02x, val=0x%02x\n",
emu->ptr, val);
list_for_each_entry(watch, &emu->watch, node) {
if (!watch->ops || !watch->ops->write)
continue;
if (watch->start <= emu->ptr && watch->end >= emu->ptr)
watch->ops->write(watch->data, emu->ptr, val);
}
emu->ptr = (emu->ptr + 1) % emu->size;
}
struct i2c_slave_client eeprom_client = {
.data = &eeprom,
.event = i2c_eeprom_emu_event,
.read = i2c_eeprom_emu_read,
.write = i2c_eeprom_emu_write
};
/*
* PXA I2C Slave mode
*/
......@@ -963,10 +836,8 @@ static int i2c_pxa_probe(struct platform_device *dev)
i2c->slave_addr = I2C_PXA_SLAVE_ADDR;
#ifdef CONFIG_I2C_PXA_SLAVE
i2c->slave = &eeprom_client;
if (plat) {
i2c->slave_addr = plat->slave_addr;
if (plat->slave)
i2c->slave = plat->slave;
}
#endif
......
#ifndef _LINUX_I2C_ALGO_PXA_H
#define _LINUX_I2C_ALGO_PXA_H
struct i2c_eeprom_emu_watcher {
void (*write)(void *, unsigned int addr, unsigned char newval);
};
struct i2c_eeprom_emu_watch {
struct list_head node;
unsigned int start;
unsigned int end;
struct i2c_eeprom_emu_watcher *ops;
void *data;
};
#define I2C_EEPROM_EMU_SIZE (256)
struct i2c_eeprom_emu {
unsigned int size;
unsigned int ptr;
unsigned int seen_start;
struct list_head watch;
unsigned char bytes[I2C_EEPROM_EMU_SIZE];
};
typedef enum i2c_slave_event_e {
I2C_SLAVE_EVENT_START_READ,
I2C_SLAVE_EVENT_START_WRITE,
......@@ -37,12 +14,4 @@ struct i2c_slave_client {
void (*write)(void *ptr, unsigned int val);
};
extern int i2c_eeprom_emu_addwatcher(struct i2c_eeprom_emu *, void *data,
unsigned int addr, unsigned int size,
struct i2c_eeprom_emu_watcher *);
extern void i2c_eeprom_emu_delwatcher(struct i2c_eeprom_emu *, void *data, struct i2c_eeprom_emu_watcher *watcher);
extern struct i2c_eeprom_emu *i2c_pxa_get_eeprom(void);
#endif /* _LINUX_I2C_ALGO_PXA_H */
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册