Add support for M16C buttons and LEDs

git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@1519 42af7a65-404d-4744-a932-0658087f49c3

3 files changed, 262 insertions, 15 deletions

diff --git a/nuttx/configs/skp16c26/src/up_buttons.c b/nuttx/configs/skp16c26/src/up_buttons.c
index 5785532bc..64d9d7345 100644
--- a/nuttx/configs/skp16c26/src/up_buttons.c
+++ b/nuttx/configs/skp16c26/src/up_buttons.c
@@ -48,6 +48,14 @@
  * Definitions
  ****************************************************************************/
 
+/* The SKP62C26 has 3 buttons control by bits 1, 2, and 3 in port 8. */
+
+#define SW1_BIT             (1 << 3)   /* Bit 3, port 8 */
+#define SW2_BIT             (1 << 2)   /* Bit 2, port 8 */
+#define SW3_BIT             (1 << 1)   /* Bit 1, port 8 */
+
+#define SW_PRESSED(p,b)     (((p) & (b)) == 0)
+
 /****************************************************************************
  * Private Data
  ****************************************************************************/
@@ -67,6 +75,11 @@
 #ifdef CONFIG_ARCH_BUTTONS
 void up_buttoninit(void)
 {
+  ubyte regval;
+
+  regval  = getreg8(M16C_PD8);
+  regval |= (SW1_BIT | SW2_BIT | SW3_BIT);
+  putreg8(regval, M16C_PD8);
 }
 
 /****************************************************************************
@@ -75,5 +88,24 @@ void up_buttoninit(void)
 
 ubyte up_buttons(void)
 {
+  ubyte swset  = 0;
+  ubyte regval = getreg8(M16C_P8);
+
+  if (SW_PRESSED(regval, SW1_BIT))
+    {
+      swset |= SW1_PRESSED;
+    }
+
+  if (SW_PRESSED(regval, SW2_BIT))
+    {
+      swset |= SW2_PRESSED;
+    }
+
+  if (SW_PRESSED(regval, SW3_BIT))
+    {
+      swset |= SW3_PRESSED;
+    }
+
+  return swset;
 }
 #endif /* CONFIG_ARCH_BUTTONS */
diff --git a/nuttx/configs/skp16c26/src/up_lcd.c b/nuttx/configs/skp16c26/src/up_lcd.c
index 81844018d..4cb08ca25 100644
--- a/nuttx/configs/skp16c26/src/up_lcd.c
+++ b/nuttx/configs/skp16c26/src/up_lcd.c
@@ -39,6 +39,7 @@
 
 #include <nuttx/config.h>
 #include <sys/types.h>
+#include <ctype.h>
 
 #include "up_arch.h"
 #include "up_internal.h"
@@ -50,24 +51,35 @@
  * Definitions
  ************************************************************************************/
 
+/* LCD dimensions *******************************************************************/
+
+#define LCD_NLINES       2          /* Two lines */
+#define LCD_NCHARS       8          /* Eight characters per line */
+
 /* LCD commands *********************************************************************/
 
-#define LCD_CLEAR        0x01    /* Clear LCD display and home cursor */
-#define LCD_HOME_L1      0x80    /* move cursor to line 1 */
-#define LCD_HOME_L2      0xc0    /* move cursor to line 2 */
-#define CURSOR_MODE_DEC  0x04    /* Cursor auto decrement after R/W */
-#define CURSOR_MODE_INC  0x06    /* Cursor auto increment after R/W */
-#define FUNCTION_SET     0x28    /* Setup, 4 bits,2 lines, 5X7 */
-#define LCD_CURSOR_ON    0x0e    /* Display ON with Cursor */
-#define LCD_CURSOR_OFF   0x0c    /* Display ON with Cursor off */
-#define LCD_CURSOR_BLINK 0x0d    /* Display on with blinking cursor */
-#define LCD_CURSOR_LEFT  0x10    /* Move Cursor Left One Position */
-#define LCD_CURSOR_RIGHT 0x14    /* Move Cursor Right One Position */
+#define LCD_CLEAR        0x01       /* Clear LCD display and home cursor */
+#define CURSOR_MODE_DEC  0x04       /* Cursor auto decrement after R/W */
+#define CURSOR_MODE_INC  0x06       /* Cursor auto increment after R/W */
+#define LCD_CURSOR_ON    0x0e       /* Display ON with Cursor */
+#define LCD_CURSOR_OFF   0x0c       /* Display ON with Cursor off */
+#define LCD_CURSOR_BLINK 0x0d       /* Display on with blinking cursor */
+#define LCD_CURSOR_LEFT  0x10       /* Move Cursor Left One Position */
+#define LCD_CURSOR_RIGHT 0x14       /* Move Cursor Right One Position */
+#define FUNCTION_SET     0x28       /* Setup, 4 bits,2 lines, 5X7 */
+#define LCD_CGRAM        0x40       /* Map characters to CG RAM */
+#define LCD_POS_L1(p)    (0x80 | p) /* Move cursor to line 1, character p+1 */
+#define LCD_POS_L2(p)    (0xc0 | p) /* Move cursor to line 2, character p+1 */
+#define LCD_HOME_L1      0x80       /* Move cursor to line 1 */
+#define LCD_HOME_L2      0xc0       /* Move cursor to line 2 */
 
 /************************************************************************************
  * Private Data
  ************************************************************************************/
 
+static ubyte g_nchars;              /* Number of characters in lines 2 */
+static ubyte g_line[LCD_NCHARS];    /* The content of lines 2 */
+
 /************************************************************************************
  * Private Functions
  ************************************************************************************/
@@ -166,6 +178,32 @@ void up_lcdwrite(boolean data, ubyte ch)
 }
 
 /************************************************************************************
+ * Name: up_scroll
+ ************************************************************************************/
+
+static void up_scroll(void)
+{
+  int i;
+
+  /* Clear the display and position the cursor at the beginning of line 1 */
+
+  up_lcdwrite(FALSE, LCD_CLEAR);
+  up_lcdwrite(FALSE, LCD_HOME_L1);
+
+  /* Copy line 2 to line 1 */
+
+  for (i = 0; i < g_nchars; i++)
+    {
+      up_lcdwrite(TRUE, g_line[i]);
+    }
+
+  /* Position the cursor at the beginning of line 2 */
+
+  up_lcdwrite(FALSE, LCD_HOME_L2);
+  g_nchars = 0;
+}
+
+/************************************************************************************
  * Public Functions
  ************************************************************************************/
 
@@ -220,7 +258,23 @@ void up_lcdinit(void)
 
 void up_lcdputc(char ch)
 {
-  up_lcdwrite(TRUE, ch);
+  /* Check for new line */
+
+  if (ch == '\n')
+    {
+      up_scroll();
+    }
+
+  /* Should we wrap to truncate at the end of line???  Let's truncate.  In either
+   * case, let's ignore all other non-printable characters.
+   */
+
+  else if (g_nchars < LCD_NCHARS && isprint(ch))
+    {
+      up_lcdwrite(TRUE, ch);
+      g_line[g_nchars] = ch;
+      g_nchars++;
+    }
 }
 
 #endif /* CONFIG_ARCH_LCD */
diff --git a/nuttx/configs/skp16c26/src/up_leds.c b/nuttx/configs/skp16c26/src/up_leds.c
index a34b47756..a65d423a9 100644
--- a/nuttx/configs/skp16c26/src/up_leds.c
+++ b/nuttx/configs/skp16c26/src/up_leds.c
@@ -39,21 +39,91 @@
 
 #include <nuttx/config.h>
 #include <sys/types.h>
+
+#include <arch/board/board.h>
+#include "up_arch.h"
 #include "up_internal.h"
+#include "chip.h"
+
+#ifdef CONFIG_ARCH_LEDS
+
+/************************************************************************************
+ * Preprocessor Definitions
+ ************************************************************************************/
+
+/* The SKP62C26 has 3 LEDs control by bits 0 and 2 in port 7 and bit 0 in port 8. */
+
+#define GREEN_LED            (1 << 2)   /* Bit 2, port 7 */
+#define YELLOW_LED           (1 << 4)   /* Bit 4, port 7 */
+#define RED_LED              (1 << 0)   /* Bit 0, port 8 */
+
+#define GREEN_LED_ON         0
+#define GREEN_LED_OFF        GREEN_LED
+#define GREEN_LED_MASK       GREEN_LED
+#define GREEN_LED_PORT       M16C_P7
+
+#define YELLOW_LED_ON        0
+#define YELLOW_LED_OFF       YELLOW_LED
+#define YELLOW_LED_MASK      YELLOW_LED
+#define YELLOW_LED_PORT      M16C_P7
+
+#define GREENYELLOW_LED_MASK (GREEN_LED_MASK|YELLOW_LED_MASK)
+#define GREENYELLOW_LED_PORT M16C_P7
+#define GREENYELLOW_DIR_PORT M16C_PD7
+
+#define RED_LED_ON           0
+#define RED_LED_OFF          RED_LED
+#define RED_LED_MASK         RED_LED
+#define RED_LED_PORT         M16C_P8
+#define RED_DIR_PORT         M16C_PD8
 
 /************************************************************************************
- * Definitions
+ * Private Type Definitions
  ************************************************************************************/
 
 /************************************************************************************
- * Private Data
+ * Private Data Definitions
  ************************************************************************************/
 
+static const ubyte g_ledstate[7] =
+{
+  (GREEN_LED_OFF | YELLOW_LED_OFF | RED_LED_OFF), /* LED_STARTED */
+  (GREEN_LED_ON  | YELLOW_LED_OFF | RED_LED_OFF), /* LED_HEAPALLOCATE */
+  (GREEN_LED_OFF | YELLOW_LED_ON  | RED_LED_OFF), /* LED_IRQSENABLED */
+  (GREEN_LED_ON  | YELLOW_LED_ON  | RED_LED_OFF), /* LED_STACKCREATED */
+
+  (GREEN_LED_ON  | YELLOW_LED_OFF | RED_LED_ON ), /* LED_INIRQ */
+  (GREEN_LED_OFF | YELLOW_LED_ON  | RED_LED_ON ), /* LED_SIGNAL */
+  (GREEN_LED_ON  | YELLOW_LED_ON  | RED_LED_ON )  /* LED_ASSERTION */
+};
+
+static ubyte g_prevled[3];
+static ubyte g_nestlevel;
+
 /************************************************************************************
  * Private Functions
  ************************************************************************************/
 
 /************************************************************************************
+ * Name: up_ledinit
+ ************************************************************************************/
+
+static void up_setleds(ubyte gybits, ubyte rbit)
+{
+  ubyte regval;
+
+  regval  = getreg8(GREENYELLOW_LED_PORT);
+  regval &= ~GREENYELLOW_LED_MASK;
+  regval |= gybits;
+  putreg8(regval, GREENYELLOW_LED_PORT);
+  
+  regval  = getreg8(RED_LED_PORT);
+  regval &= ~RED_LED_MASK;
+  regval |= rbit;
+  putreg8(regval, RED_LED_PORT);
+}
+
+/************************************************************************************
  * Public Functions
  ************************************************************************************/
 
@@ -61,9 +131,29 @@
  * Name: up_ledinit
  ************************************************************************************/
 
-#ifdef CONFIG_ARCH_LEDS
 void up_ledinit(void)
 {
+  register ubyte regval;
+
+  /* Make sure that the LEDs are in the OFF state */
+
+  regval  = getreg8(GREENYELLOW_LED_PORT);
+  regval |= (GREEN_LED_OFF |YELLOW_LED_OFF);
+  putreg8(regval, GREENYELLOW_LED_PORT);
+  
+  regval  = getreg8(RED_LED_PORT);
+  regval |=  RED_LED_OFF;
+  putreg8(regval, RED_LED_PORT);
+
+  /* Set the direction to output */
+  
+  regval  = getreg8(GREENYELLOW_DIR_PORT);
+  regval |= (GREEN_LED |YELLOW_LED);
+  putreg8(regval, GREENYELLOW_DIR_PORT);
+  
+  regval  = getreg8(RED_DIR_PORT);
+  regval |=  RED_LED;
+  putreg8(regval, RED_DIR_PORT);
 }
 
 /************************************************************************************
@@ -72,6 +162,34 @@ void up_ledinit(void)
 
 void up_ledon(int led)
 {
+  ubyte ledset;
+
+  /* If this is the ASSERTION led, preserve the Y&G bits from the last setting and
+   * set the RED LED on.
+   */
+
+  if (led == LED_ASSERTION)
+    {
+      ledset = g_ledstate[g_prevled[g_nestlevel]];
+      up_setleds(ledset & GREENYELLOW_LED_MASK, RED_LED_ON);
+    }
+  else if (led < LED_ASSERTION)
+    {
+      /* Otherwise, just show the LEDs corresponding to this state */
+
+      ledset = g_ledstate[led];
+      up_setleds(ledset & GREENYELLOW_LED_MASK, ledset & RED_LED_MASK);
+
+      /* If this was a nested states (INIRQ, SIGNAL, or ASSERTION) then
+       * stack up the previous value.
+       */
+
+      if (led > LED_STACKCREATED)
+        {
+          g_nestlevel++;
+        }
+      g_prevled[g_nestlevel] = led;
+    }
 }
 
 /************************************************************************************
@@ -80,5 +198,48 @@ void up_ledon(int led)
 
 void up_ledoff(int led)
 {
+  ubyte ledset;
+
+  /* If this is the ASSERTION led then what we do depends on the previous state */
+
+  if (led == LED_ASSERTION)
+    {
+      /* If the previous state was one of the nested states (INIRQ, SIGNAL, or ASSERTION),
+       * then turn the green and yellow LEDs all off.  That way we can distinguish
+       * that case from the simple cases.
+       */
+
+      if (g_nestlevel > 0)
+        {
+          ledset = 0;
+        }
+      else
+        {
+          ledset = g_ledstate[g_prevled[0]];
+        }
+      up_setleds(ledset & GREENYELLOW_LED_MASK, RED_LED_OFF);
+    }
+  else if (led > 0 && led < LED_ASSERTION)
+    {
+      /* If this was one of the nested states, then we want to back to the LED setting
+       * before entering that nested statel.
+       */
+
+      if (g_nestlevel > 0)
+        {
+          g_nestlevel--;
+          led = g_prevled[g_nestlevel];
+        }
+      else if (led > LED_STACKCREATED)
+        {
+	  /* This shouldn't happen */
+
+          led--;
+        }
+      ledset = g_ledstate[led];
+      up_setleds(ledset & GREENYELLOW_LED_MASK, ledset & RED_LED_MASK);
+      g_prevled[g_nestlevel]= led;
+    }
 }
+
 #endif /* CONFIG_ARCH_LEDS */