=================================================================== RCS file: /cvs/funnyos/arch/testarm/dev/tartc.c,v retrieving revision 1.1 retrieving revision 1.2 diff -u -r1.1 -r1.2 --- funnyos/arch/testarm/dev/tartc.c 2007/10/16 09:41:04 1.1 +++ funnyos/arch/testarm/dev/tartc.c 2007/10/29 15:10:34 1.2 @@ -1,21 +1,49 @@ /* - * $Id: tartc.c,v 1.1 2007/10/16 08:41:04 init Exp $ + * $Id: tartc.c,v 1.2 2007/10/29 15:10:34 init Exp $ */ #include #include +#include + +#include +#include #include /* * testarm Real Time Clock driver. */ +int tartc_attach(struct device *, uint32_t loc, uint8_t flags); -/* TODO */ +struct driver tartc_dr = { + sizeof(struct tartc_dd), + tartc_attach, + NULL +}; + + int -tartc_attach(struct device *self) +tartc_attach(struct device *self, uint32_t loc, uint8_t flags) { + struct tartc_dd *ddp = self->dv_devdata; + uint32_t seconds; - printf("testarm Real Time Clock\n"); + /* acquire bus_handle from parent */ + ddp->td_bushandlep = self->dv_parent->dv_aux; + + /* save our location on parent (or use default if loc == 0) */ + ddp->td_ioaddr = (loc != 0) ? loc : TARTC_REG_BASE; + + /* + * Read seconds past Epoch. + */ + /* trigger clock update on host */ + bus_write_1(ddp->td_bushandlep, ddp->td_ioaddr + TARTC_OFF_CLOCKUPDATE, 1); + + /* get seconds past Epoch */ + seconds = bus_read_4(ddp->td_bushandlep, ddp->td_ioaddr + TARTC_OFF_READSECONDS); + + printf("testarm Real Time Clock (%d seconds past Epoch)\n", seconds); return(0);