From 61319fc705563c68e8f40ca9857b1521b8d47ba9 Mon Sep 17 00:00:00 2001
From: gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4>
Date: Tue, 30 Oct 2007 16:32:55 +0000
Subject: git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@70
 35acf78f-673a-0410-8e92-d51de3d6d3f4

---
 ports/ARM7-LPC214x/GCC/lpc214x_ssp.c | 85 ++++++++++++++++++++++++++++++++++--
 ports/ARM7-LPC214x/GCC/lpc214x_ssp.h |  5 ++-
 2 files changed, 85 insertions(+), 5 deletions(-)

(limited to 'ports/ARM7-LPC214x/GCC')

diff --git a/ports/ARM7-LPC214x/GCC/lpc214x_ssp.c b/ports/ARM7-LPC214x/GCC/lpc214x_ssp.c
index 4168b6157..473ca169a 100644
--- a/ports/ARM7-LPC214x/GCC/lpc214x_ssp.c
+++ b/ports/ARM7-LPC214x/GCC/lpc214x_ssp.c
@@ -23,10 +23,49 @@
 #include "lpc214x_ssp.h"
 
 static BYTE8 *ip, *op;
-static t_size icnt, ocnt;
+static int icnt, ocnt;
 static t_sspnotify callback;
+static void *cbpar;
 
 void SSPIrq(void) {
+  SSP *ssp = SSPBase;
+  BYTE8 b;
+
+  while (ssp->SSP_MIS & (MIS_ROR | MIS_RT | MIS_RX | MIS_TX)) {
+
+    if (ssp->SSP_MIS & MIS_ROR)
+      chSysHalt();
+
+    if (ssp->SSP_MIS & (MIS_RX | MIS_RT)) {
+      ssp->SSP_ICR = ICR_RT;
+      while (ssp->SSP_SR & SR_RNE) {
+        b = ssp->SSP_DR;
+        if (ip)
+          *ip++ = b;
+        icnt--;
+      }
+      if (icnt <= 0) { /* It should never become less than zero */
+        t_sspnotify fn = callback;
+        callback = NULL;
+        ssp->SSP_IMSC = 0;
+        VICVectAddr = 0;
+        fn(cbpar);
+        return;
+      }
+      continue;
+    }
+    /* It is MIS_TX, no need to test it again. */
+    while (ocnt && (ssp->SSP_SR & SR_TNF)) {
+      if (op)
+        ssp->SSP_DR = *op++;
+      else
+        ssp->SSP_DR = 0xFF;
+      ocnt--;
+    }
+    if (!ocnt)
+      ssp->SSP_IMSC = IMSC_ROR | IMSC_RT | IMSC_RX;
+  }
+  VICVectAddr = 0;
 }
 
 /*
@@ -37,19 +76,57 @@ void SSPIrq(void) {
  *           \p NULL then 0xFF bytes will be output.
  * @param n the number of bytes to be transferred
  * @param fn callback function invoked when the operation is done
- * @return \p SSP_OK if the trasfer is started else \p SSP_RUNNING if a
+ * @param par parameter to be passed to the callback function
+ * @return \p SSP_OK if the trasfer was started else \p SSP_RUNNING if a
  *         an operation was already started
  */
-t_msg sspRWI(BYTE8 *in, BYTE8 *out, t_size n, t_sspnotify fn) {
+t_msg sspRWI(BYTE8 *in, BYTE8 *out, t_size n, t_sspnotify fn, void *par) {
 
   if (callback)
     return SSP_RUNNING;
 
-  callback = fn, ip = in, op = out, icnt = ocnt = n;
+  callback = fn, cbpar = par, ip = in, op = out, icnt = ocnt = n;
   SSPIMSC = IMSC_ROR | IMSC_RT | IMSC_RX | IMSC_TX;
   return SSP_OK;
 }
 
+
+static void done(void *tp) {
+
+  chThdResumeI(tp);
+}
+
+/*
+ * Synchronous SSP transfer.
+ * @param in pointer to the incoming data buffer, if this parameter is set to
+ *           \p NULL then the incoming data is discarded.
+ * @param out pointer to the outgoing data buffer, if this parameter is set to
+ *           \p NULL then 0xFF bytes will be output.
+ * @param n the number of bytes to be transferred
+ * @return \p SSP_OK if the trasfer was performed else \p SSP_RUNNING if a
+ *         an operation was already started
+ */
+t_msg sspRW(BYTE8 *in, BYTE8 *out, t_size n) {
+
+  chSysLock();
+
+  t_msg sts = sspRWI(in, out, n, done, chThdSelf());
+  if (sts == SSP_OK)
+    chSchGoSleepS(PRSUSPENDED);
+
+  chSysUnlock();
+  return sts;
+}
+
+/*
+ * Checks if a SSP operation is running.
+ * @return \p TRUE if an asynchronous operation is already running.
+ */
+BOOL sspIsRunningI(void) {
+
+  return callback != NULL;
+}
+
 /*
  * SSP setup, must be invoked with interrupts disabled.
  * Do not invoke while an operation is in progress.
diff --git a/ports/ARM7-LPC214x/GCC/lpc214x_ssp.h b/ports/ARM7-LPC214x/GCC/lpc214x_ssp.h
index 655a6b1e0..093edc952 100644
--- a/ports/ARM7-LPC214x/GCC/lpc214x_ssp.h
+++ b/ports/ARM7-LPC214x/GCC/lpc214x_ssp.h
@@ -23,10 +23,13 @@
 #define SSP_OK      RDY_OK
 #define SSP_RUNNING -3
 
-typedef void (*t_sspnotify)(void);
+typedef void (*t_sspnotify)(void *par);
 
 void InitSSP(void);
 void SetSSPI(int cpsr, int cr0, int cr1);
 void SSPIrqHandler(void);
 
+t_msg sspRWI(BYTE8 *in, BYTE8 *out, t_size n, t_sspnotify fn, void *par);
+BOOL sspIsRunningI(void);
+
 #endif /* _LPC214x_SSP_H_*/
-- 
cgit v1.2.3