=================================================================== RCS file: /cvs/funnyos/arch/testarm/dev/obio.c,v retrieving revision 1.4 retrieving revision 1.11 diff -u -r1.4 -r1.11 --- funnyos/arch/testarm/dev/obio.c 2007/10/16 19:42:00 1.4 +++ funnyos/arch/testarm/dev/obio.c 2007/10/29 21:10:03 1.11 @@ -1,5 +1,5 @@ /* - * $Id: obio.c,v 1.4 2007/10/16 18:42:00 init Exp $ + * $Id: obio.c,v 1.11 2007/10/29 21:10:03 init Exp $ */ #include #include @@ -9,22 +9,33 @@ #include #include +/* #define OBIO_DEBUG */ + +#ifdef OBIO_DEBUG +#define DPRINTF(x...) do { printf(x); } while (0) +#else +#define DPRINTF(x...) { } +#endif + /* * testarm obio (on-board i/o) support. * This is a simple memory read/writes. */ -uint8_t obio_read_1(struct device *, uint32_t); -uint16_t obio_read_2(struct device *, uint32_t); -uint32_t obio_read_4(struct device *, uint32_t); -int obio_write_1(struct device *, uint32_t, uint8_t); -int obio_write_2(struct device *, uint32_t, uint16_t); -int obio_write_4(struct device *, uint32_t, uint32_t); +int obio_attach(struct device *, uint32_t, uint8_t); +uint8_t obio_read_1(void *, uint32_t); +uint16_t obio_read_2(void *, uint32_t); +uint32_t obio_read_4(void *, uint32_t); +int obio_write_1(void *, uint32_t, uint8_t); +int obio_write_2(void *, uint32_t, uint16_t); +int obio_write_4(void *, uint32_t, uint32_t); + struct driver obio_dr = { - sizeof(obio_dd), + sizeof(struct obio_dd), obio_attach, - obio_detach + NULL, + NULL }; @@ -32,7 +43,7 @@ obio_attach(struct device *self, uint32_t loc, uint8_t flags) { struct obio_dd *ddp = self->dv_devdata; - struct bus_handle *bhp = ddp->od_bh; + struct bus_handle *bhp = &ddp->od_bh; ddp->od_locked = 0; ddp->od_ndevices = 0; @@ -43,6 +54,7 @@ bhp->bus_write_1 = obio_write_1; bhp->bus_write_2 = obio_write_2; bhp->bus_write_4 = obio_write_4; + bhp->bh_ownerdd = self->dv_devdata; /* XXX UGLY bus_{read|write} stuff will access bus device from bus_handle using this */ /* expose our bus_handle to the world */ self->dv_aux = bhp; @@ -54,32 +66,37 @@ uint8_t -obio_read_1(struct obio_dd *ddp, uint32_t addr) +obio_read_1(void *ddp, uint32_t addr) { /* * There is only one on-board i/o bus in testarm. */ + DPRINTF("obio_read_1: read @0x%x\n", addr); return( (*(uint8_t *)addr) ); } uint16_t -obio_read_2(struct obio_dd *ddp, uint32_t addr) +obio_read_2(void *ddp, uint32_t addr) { + DPRINTF("obio_read_2: read @0x%x\n", addr); return( (*(uint16_t *)addr) ); } uint32_t -obio_read_4(struct obio_dd *ddp, uint32_t addr) +obio_read_4(void *ddp, uint32_t addr) { + DPRINTF("obio_read_4: read @0x%x\n", addr); return( (*(uint32_t *)addr) ); } int -obio_write_1(struct obio_dd *ddp, uint32_t addr, uint8_t data) +obio_write_1(void *ddp, uint32_t addr, uint8_t data) { + DPRINTF("obio_write_1: write @0x%x data %d\n", addr, data); + *((uint8_t *)addr) = data; /* XXX what about write errors? */ @@ -88,8 +105,10 @@ int -obio_write_2(struct obio_dd *ddp, uint32_t addr, uint16_t data) +obio_write_2(void *ddp, uint32_t addr, uint16_t data) { + DPRINTF("obio_write_2: write @0x%x data %d\n", addr, data); + *((uint16_t *)addr) = data; return(0); @@ -97,8 +116,10 @@ int -obio_write_4(struct obio_dd *ddp, uint32_t addr, uint32_t data) +obio_write_4(void *ddp, uint32_t addr, uint32_t data) { + DPRINTF("obio_write_4: write @0x%x data %d\n", addr, data); + *((uint32_t *)addr) = data; return(0);