diff options
-rw-r--r-- | openpcd/firmware/Makefile | 2 | ||||
-rw-r--r-- | openpcd/firmware/src/os/pit.c | 38 | ||||
-rw-r--r-- | openpcd/firmware/src/os/pit.h | 7 |
3 files changed, 46 insertions, 1 deletions
diff --git a/openpcd/firmware/Makefile b/openpcd/firmware/Makefile index f4ff886..1101495 100644 --- a/openpcd/firmware/Makefile +++ b/openpcd/firmware/Makefile @@ -87,7 +87,7 @@ SRCARM += src/os/pcd_enumerate.c src/os/fifo.c src/os/dbgu.c \ src/os/led.c src/os/req_ctx.c src/os/trigger.c \ src/os/main.c src/os/syscalls.c src/os/usb_handler.c \ src/os/usb_benchmark.c src/os/dfu.c src/start/Cstartup_SAM7.c \ - src/os/tc_cdiv.c + src/os/tc_cdiv.c src/os/pit.c ifdef PCD # PCD support code diff --git a/openpcd/firmware/src/os/pit.c b/openpcd/firmware/src/os/pit.c new file mode 100644 index 0000000..409faef --- /dev/null +++ b/openpcd/firmware/src/os/pit.c @@ -0,0 +1,38 @@ + + +#include <errno.h> +#include <sys/types.h> +#include <lib_AT91SAM7.h> +#include <AT91SAM7.h> +#include "../openpcd.h" + +/* PIT runs at MCK/16 (= 3MHz) */ +#define PIV_MS(x) (x * 3000) + +static void pit_irq(void) +{ + /* FIXME: do something */ +} + +void pit_mdelay(u_int32_t ms) +{ + u_int32_t end; + + end = (AT91F_PITGetPIIR(AT91C_BASE_PITC) + ms) % 20; + + while (end < AT91F_PITGetPIIR(AT91C_BASE_PITC)) { } +} + +void pit_init(void) +{ + AT91F_PITC_CfgPMC(); + + AT91F_PITInit(AT91C_BASE_PITC, 1000 /* uS */, 48 /* MHz */); + + AT91F_AIC_ConfigureIt(AT91C_BASE_AIC, AT91C_ID_SYS, + OPENPCD_IRQ_PRIO_PIT, + AT91C_AIC_SRCTYPE_INT_POSITIVE_EDGE, + &pit_irq); + + //AT91F_PITEnableInt(AT91C_BASE_PITC); +} diff --git a/openpcd/firmware/src/os/pit.h b/openpcd/firmware/src/os/pit.h new file mode 100644 index 0000000..92426e9 --- /dev/null +++ b/openpcd/firmware/src/os/pit.h @@ -0,0 +1,7 @@ +#ifndef _PIT_H +#define _PIT_H + +extern void pit_init(void); +extern void pit_mdelay(u_int32_t ms); + +#endif |