Add z16f LED logic

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

arch/z16/src/z16f/z16f_head.S

@@ -46,6 +46,9 @@
  **************************************************************************/
 
 	xref _z16f_lowinit:EROM
+#ifdef CONFIG_ARCH_LEDS
+	xref	_up_ledinit:EROM
+#endif
 #if defined(CONFIG_ARCH_LOWPUTC) || defined(CONFIG_ARCH_LOWGETC)
 	xref _z16f_lowuartinit:EROM
 #endif
@@ -164,6 +167,11 @@ _reset:
 	ld	sp, #(_near_stack+1)	/* Set Stack Pointer to the top of internal RAM */
 	clr	fp
 
+	/* Initialize onboard LEDs */
+
+#ifdef CONFIG_ARCH_LEDS
+	bl	_up_ledinit
+#endif
 	/* Perform VERY early UART initialization so that we can use it here */
 
 #if defined(CONFIG_ARCH_LOWPUTC) || defined(CONFIG_ARCH_LOWGETC)

configs/z16f2800100zcog/include/board.h

-/************************************************************
+/****************************************************************************
  * board/board.h
  *
  *   Copyright (C) 2008 Gregory Nutt. All rights reserved.
@@ -31,22 +31,41 @@
  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  * POSSIBILITY OF SUCH DAMAGE.
  *
- ************************************************************/
+ ****************************************************************************/
 
 #ifndef __ARCH_BOARD_BOARD_H
 #define __ARCH_BOARD_BOARD_H
 
-/************************************************************
+/****************************************************************************
  * Included Files
- ************************************************************/
+ ****************************************************************************/
 
-/************************************************************
+/****************************************************************************
  * Definitions
- ************************************************************/
+ ****************************************************************************/
 
-/************************************************************
+/* LED pattern definitions
+ *
+ * The z16f2800100zcog board has four LEDs:
+ *
+ * - Green LED D1 which illuminates in the presence of Vcc
+ * - Red LED D2 connected to chip port PA0_T0IN
+ * - Yellow LED D3 connected to chip port PA1_T0OUT
+ * - Green LED D4 connected to chip port PA2_DE0
+ */
+
+#define LED_STARTED                 0
+#define LED_HEAPALLOCATE            1
+#define LED_IRQSENABLED             2
+#define LED_IDLE                    3
+#define LED_INIRQ                   4
+#define LED_ASSERTION               5
+#define LED_PANIC                   6
+
+/****************************************************************************
  * Public Functions
- ************************************************************/
+ ****************************************************************************/
+
 #undef EXTERN
 #if defined(__cplusplus)
 #define EXTERN extern "C"

configs/z16f2800100zcog/src/Makefile

@@ -43,7 +43,7 @@ CFLAGS		= $(ARCHWARNINGS) $(ARCHOPTIMIZATION) $(ARCHCPUFLAGS) $(INCLUDES) $(ARCH
 
 ASRCS		= 
 AOBJS		= $(ASRCS:.S=$(OBJEXT))
-CSRCS		= z16f_lowinit.c
+CSRCS		= z16f_lowinit.c z16f_leds.c
 COBJS		= $(CSRCS:.c=$(OBJEXT))
 
 SRCS		= $(ASRCS) $(CSRCS)

configs/z16f2800100zcog/src/z16f_leds.c

+/****************************************************************************
+ * up_leds.c
+ *
+ *   Copyright (C) 2008 Gregory Nutt. All rights reserved.
+ *   Author: Gregory Nutt <spudmonkey@racsa.co.cr>
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ * 3. Neither the name NuttX nor the names of its contributors may be
+ *    used to endorse or promote products derived from this software
+ *    without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
+ * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
+ * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ *
+ ****************************************************************************/
+
+/* The z16f2800100zcog board has four LEDs:
+ *
+ * - Green LED D1 which illuminates in the presence of Vcc
+ * - Red LED D2 connected to chip port PA0_T0IN
+ * - Yellow LED D3 connected to chip port PA1_T0OUT
+ * - Green LED D4 connected to chip port PA2_DE0
+ */
+
+/****************************************************************************
+ * Included Files
+ ****************************************************************************/
+
+#include <nuttx/config.h>
+#include <sys/types.h>
+#include "up_internal.h"
+
+/****************************************************************************
+ * Definitions
+ ****************************************************************************/
+
+/****************************************************************************
+ * Private Data
+ ****************************************************************************/
+
+/****************************************************************************
+ * Private Functions
+ ****************************************************************************/
+
+/****************************************************************************
+ * Public Functions
+ ****************************************************************************/
+
+/****************************************************************************
+ * Name: up_ledinit
+ ****************************************************************************/
+
+#ifdef CONFIG_ARCH_LEDS
+void up_ledinit(void)
+{
+  /* The following is performed up_lowinit() as well */
+
+  putreg8(getreg8(Z16F_GPIOA_OUT) | 0x07, Z16F_GPIOA_OUT);
+  putreg8(getreg8(Z16F_GPIOA_DD) & 0xF8, Z16F_GPIOA_DD);
+}
+
+/****************************************************************************
+ * Name: up_ledon
+ ****************************************************************************/
+
+void up_ledon(int led)
+{
+  ubyte paout = getreg8(Z16F_GPIOA_OUT) & 0xf8;
+  switch (led)
+    {
+      case LED_STARTED:
+        break;
+
+      case LED_HEAPALLOCATE:
+        paout |= 1;
+        break;
+
+      case LED_IRQSENABLED:
+        paout |= 2;
+        break;
+
+      case LED_IDLE:
+        paout |= 3;
+        break;
+
+      case LED_INIRQ:
+        paout |= 4;
+        break;
+
+      case LED_ASSERTION :
+        paout |= 5;
+        break;
+
+      case LED_PANIC:
+      default:
+        paout |= 6;
+        break;
+    }
+  putreg8(paout, Z16F_GPIOA_OUT);
+}
+
+/****************************************************************************
+ * Name: up_ledoff
+ ****************************************************************************/
+
+void up_ledoff(int led)
+{
+  switch (led)
+    {
+      case LED_STARTED:
+        break;
+
+      case LED_HEAPALLOCATE:
+        up_ledoff(LED_STARTED);
+        break;
+
+      case LED_IRQSENABLED:
+        up_ledoff(LED_IRQSENABLED);
+        break;
+
+      case LED_IDLE:
+        up_ledoff(LED_IRQSENABLED);
+        break;
+
+      case LED_INIRQ:
+      case LED_ASSERTION :
+        up_ledoff(LED_IDLE);
+        break;
+
+      case LED_PANIC:
+      default:
+        up_ledoff(LED_ASSERTION);
+        break;
+    }
+}
+#endif /* CONFIG_ARCH_LEDS */

configs/z16f2800100zcog/src/z16f_lowinit.c

@@ -58,7 +58,7 @@ static void z16f_gpioinit(void)
 
   putreg8(getreg8(Z16F_GPIOA_DD) | 0x87, Z16F_GPIOA_DD);
   putreg8(getreg8(Z16F_GPIOA_OUT) | 0x07, Z16F_GPIOA_OUT);
-  putreg8(getreg8(Z16F_GPIOA_DD) | 0xF8, Z16F_GPIOA_DD);
+  putreg8(getreg8(Z16F_GPIOA_DD) & 0xF8, Z16F_GPIOA_DD);
 
   /* Configure rate switch port */