From 677e0b6eabbfc87f5728f905ffded6216ee1cb3f Mon Sep 17 00:00:00 2001 From: "(no author)" <(no author)@6dc7ffe9-61d6-0310-9af1-9938baff3ed1> Date: Sat, 9 Sep 2006 18:18:39 +0000 Subject: add PIT support code git-svn-id: https://svn.openpcd.org:2342/trunk@161 6dc7ffe9-61d6-0310-9af1-9938baff3ed1 --- openpcd/firmware/Makefile | 2 +- openpcd/firmware/src/os/pit.c | 38 ++++++++++++++++++++++++++++++++++++++ openpcd/firmware/src/os/pit.h | 7 +++++++ 3 files changed, 46 insertions(+), 1 deletion(-) create mode 100644 openpcd/firmware/src/os/pit.c create mode 100644 openpcd/firmware/src/os/pit.h 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 +#include +#include +#include +#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 -- cgit v1.2.3