version 1.4, 2007/10/16 19:42:00 |
version 1.11, 2007/10/29 21:10:03 |
|
|
#include <arch/testarm/dev/obiovar.h> |
#include <arch/testarm/dev/obiovar.h> |
#include <libkern/printf.h> |
#include <libkern/printf.h> |
|
|
|
/* #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. |
* testarm obio (on-board i/o) support. |
* This is a simple memory read/writes. |
* This is a simple memory read/writes. |
*/ |
*/ |
uint8_t obio_read_1(struct device *, uint32_t); |
int obio_attach(struct device *, uint32_t, uint8_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); |
|
|
|
|
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 = { |
struct driver obio_dr = { |
sizeof(obio_dd), |
sizeof(struct obio_dd), |
obio_attach, |
obio_attach, |
obio_detach |
NULL, |
|
NULL |
}; |
}; |
|
|
|
|
|
|
obio_attach(struct device *self, uint32_t loc, uint8_t flags) |
obio_attach(struct device *self, uint32_t loc, uint8_t flags) |
{ |
{ |
struct obio_dd *ddp = self->dv_devdata; |
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_locked = 0; |
ddp->od_ndevices = 0; |
ddp->od_ndevices = 0; |
|
|
bhp->bus_write_1 = obio_write_1; |
bhp->bus_write_1 = obio_write_1; |
bhp->bus_write_2 = obio_write_2; |
bhp->bus_write_2 = obio_write_2; |
bhp->bus_write_4 = obio_write_4; |
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 */ |
/* expose our bus_handle to the world */ |
self->dv_aux = bhp; |
self->dv_aux = bhp; |
|
|
|
|
|
|
uint8_t |
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. |
* There is only one on-board i/o bus in testarm. |
*/ |
*/ |
|
DPRINTF("obio_read_1: read @0x%x\n", addr); |
return( (*(uint8_t *)addr) ); |
return( (*(uint8_t *)addr) ); |
} |
} |
|
|
|
|
uint16_t |
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) ); |
return( (*(uint16_t *)addr) ); |
} |
} |
|
|
|
|
uint32_t |
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) ); |
return( (*(uint32_t *)addr) ); |
} |
} |
|
|
|
|
int |
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; |
*((uint8_t *)addr) = data; |
|
|
/* XXX what about write errors? */ |
/* XXX what about write errors? */ |
|
|
|
|
|
|
int |
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; |
*((uint16_t *)addr) = data; |
|
|
return(0); |
return(0); |
|
|
|
|
|
|
int |
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; |
*((uint32_t *)addr) = data; |
|
|
return(0); |
return(0); |