forked from luck/tmp_suning_uos_patched
[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: Russell King <rmk+kernel@arm.linux.org.uk>
This commit is contained in:
Russell King
Russell King
parent
df58d03595
commit
beea494d5e
|
|
@ -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,11 +836,9 @@ 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;
|
||||
i2c->slave = plat->slave;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
|
|
|||
|
|
@ -1,29 +1,6 @@
|
|||
#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 */
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user