diff options
| author | gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4> | 2007-11-03 16:25:52 +0000 |
|---|---|---|
| committer | gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4> | 2007-11-03 16:25:52 +0000 |
| commit | aece9ea5fcc12bc2ac7178bb231c9b7084518ff3 (patch) | |
| tree | 0520555b41b0364aed481f01d71b906cc8c1752f /demos/ARM7-LPC214x-GCC/mmcsd.c | |
| parent | 50cd4e00ef4614552dba01b865688c66629e1958 (diff) | |
| download | ChibiOS-aece9ea5fcc12bc2ac7178bb231c9b7084518ff3.tar.gz ChibiOS-aece9ea5fcc12bc2ac7178bb231c9b7084518ff3.tar.bz2 ChibiOS-aece9ea5fcc12bc2ac7178bb231c9b7084518ff3.zip | |
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@83 35acf78f-673a-0410-8e92-d51de3d6d3f4
Diffstat (limited to 'demos/ARM7-LPC214x-GCC/mmcsd.c')
| -rw-r--r-- | demos/ARM7-LPC214x-GCC/mmcsd.c | 55 |
1 files changed, 54 insertions, 1 deletions
diff --git a/demos/ARM7-LPC214x-GCC/mmcsd.c b/demos/ARM7-LPC214x-GCC/mmcsd.c index 7867782c9..fb1c5c650 100644 --- a/demos/ARM7-LPC214x-GCC/mmcsd.c +++ b/demos/ARM7-LPC214x-GCC/mmcsd.c @@ -24,7 +24,10 @@ #include "mmcsd.h"
-static EventSource MMCInsertEventSource;
+EventSource MMCInsertEventSource, MMCRemoveEventSource;
+
+static VirtualTimer vt;
+static int cnt;
/*
* Subsystem initialization.
@@ -32,6 +35,56 @@ static EventSource MMCInsertEventSource; void InitMMC(void) {
chEvtInit(&MMCInsertEventSource);
+ chEvtInit(&MMCRemoveEventSource);
+ cnt = POLLING_INTERVAL;
+}
+
+void tmrfunc(void *par) {
+
+ if (cnt) {
+ if (!(IO1PIN & (1 << 25))) {
+ if (!--cnt)
+ chEvtSendI(&MMCInsertEventSource);
+ }
+ else
+ cnt = POLLING_INTERVAL;
+ }
+ else {
+ if (IO1PIN & (1 << 25)) {
+ cnt = POLLING_INTERVAL;
+ chEvtSendI(&MMCRemoveEventSource);
+ }
+ }
+ chVTSetI(&vt, 10, tmrfunc, NULL);
+}
+
+void mmcStartPolling(void) {
+
+ chSysLock();
+
+ if (!chVTIsArmedI(&vt)) {
+ chVTSetI(&vt, 10, tmrfunc, NULL);
+ cnt = POLLING_INTERVAL;
+ }
+
+ chSysUnlock();
+}
+
+void mmcStopPolling(void) {
+
+ chSysLock();
+
+ if (chVTIsArmedI(&vt)) {
+ chVTResetI(&vt);
+ cnt = POLLING_INTERVAL;
+ }
+
+ chSysUnlock();
+}
+
+BOOL mmcCardInserted (void) {
+
+ return cnt == 0;
}
static void sendhdr(BYTE8 cmd, ULONG32 arg) {
|