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

(limited to 'openpcd')

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
-- 
cgit v1.2.3