Add M16C interrupt/context switch logic

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

5 files changed, 308 insertions, 113 deletions

diff --git a/nuttx/arch/sh/src/m16c/Make.defs b/nuttx/arch/sh/src/m16c/Make.defs
index 39da7460b..fe28a2dfd 100644
--- a/nuttx/arch/sh/src/m16c/Make.defs
+++ b/nuttx/arch/sh/src/m16c/Make.defs
@@ -42,7 +42,6 @@ CMN_CSRCS	= up_allocateheap.c up_assert.c up_blocktask.c \
 		  up_releasepending.c up_releasestack.c up_reprioritizertr.c \
 		  up_udelay.c up_unblocktask.c up_usestack.c
 
-#CHIP_ASRCS	= m16c_vectors.S m16c_saveusercontext.S m16c_restorecontext.S
 CHIP_ASRCS	= m16c_vectors.S
 #CHIP_CSRCS	= m16c_initialstate.c m16c_copystate.c m16c_lowputc.c m16c_irq.c \
 #		  m16c_timerisr.c m16c_serial.c
diff --git a/nuttx/arch/sh/src/m16c/m16c_copystate.c b/nuttx/arch/sh/src/m16c/m16c_copystate.c
index e66637ab9..c74b57675 100644
--- a/nuttx/arch/sh/src/m16c/m16c_copystate.c
+++ b/nuttx/arch/sh/src/m16c/m16c_copystate.c
@@ -40,6 +40,7 @@
 #include <nuttx/config.h>
 
 #include <sys/types.h>
+#include <string.h>
 
 #include "os_internal.h"
 #include "up_internal.h"
diff --git a/nuttx/arch/sh/src/m16c/m16c_head.S b/nuttx/arch/sh/src/m16c/m16c_head.S
index 52b9fdb7f..919dcf2d2 100644
--- a/nuttx/arch/sh/src/m16c/m16c_head.S
+++ b/nuttx/arch/sh/src/m16c/m16c_head.S
@@ -145,7 +145,7 @@ __start:
 /* Set the interrupt and user stack pointers */
 
 	mov.w	#_enbss, R0
-	ldc	R0, isp			/* Set interrupt thread stack pointer to the end of BSS */
+	ldc	R0, isp			/* Set the interrupt stack pointer to the end of BSS */
 	add.w	#CONFIG_IDLETHREAD_STACKSIZE, R0
 	fset	U			/* Set bit 7 (U) to select the user stack pointer */
 	ldc	R0, sp			/* Set the user stack pointer */
@@ -190,8 +190,8 @@ __start:
 
 /* Initialize near .data sections (.rodata is not moved) */
 
-	mov.w	_g_enronly, a0		/* a0: Low 16 bits of source */
-	mov.b	_g_enronly+2, r1h	/* r1h: 4 order bits of source */
+	mov.w	_g_enronly, a0		/* a0: Low 16 bits of source address */
+	mov.b	_g_enronly+2, r1h	/* 4 MS of 20-bit source address */
 	mov.w	_g_sndata, a1		/* a1: start of near .data */
 	mov.w	_g_endata, r3		/* r3: end of near .data */
 	sub.w	a1, r3			/* r3: size of near .data */
@@ -212,4 +212,5 @@ __start:
 
 _os_exit:
 	jmp.s	_os_exit
+	.size	__start, .-__start
 	.end
diff --git a/nuttx/arch/sh/src/m16c/m16c_initialstate.c b/nuttx/arch/sh/src/m16c/m16c_initialstate.c
index 10dbd2d88..e4c556788 100644
--- a/nuttx/arch/sh/src/m16c/m16c_initialstate.c
+++ b/nuttx/arch/sh/src/m16c/m16c_initialstate.c
@@ -48,7 +48,7 @@
  * Preprocessor Definitions
  ****************************************************************************/
 
-#define M16C_DEFAULT_IPL   0     /* Global M16C Interrupt priority level */
+#define M16C_DEFAULT_IPL   0     /* Default M16C Interrupt priority level */
 
 /****************************************************************************
  * Private Data
@@ -59,24 +59,6 @@
  ****************************************************************************/
 
 /****************************************************************************
- * Name: up_getsr
- ****************************************************************************/
-
-static inline irqstate_t up_getsr(void)
-{
-  irqstate_t flags;
-
-  __asm__ __volatile__
-    (
-      "stc     sr, %0\n\t"
-      : "=&z" (flags)
-      :
-      : "memory"
-    );
-  return flags;
-}
-
-/****************************************************************************
  * Public Functions
  ****************************************************************************/
 
@@ -102,22 +84,26 @@ void up_initial_state(FAR _TCB *tcb)
 
   memset(xcp, 0, sizeof(struct xcptcontext));
 
-  /* Offset 0-2: 20-bit PC [0]:bits 16-19 [1]:bits 8-15 [2]: bits 0-7 */
-
-  *regs++ = (uint32)tcb->start >> 16; /* Bits 16-19 of PC */
-  *regs++ = (uint32)tcb->start >> 8;  /* Bits 8-15 of PC */
-  *regs++ = (uint32)tcb->start;       /* Bits 0-7 of PC */
-
-  /* Offset 3: FLG (bits 12-14) PC (bits 16-19) as would be present by an interrupt */
+  /* Offset 0: FLG (bits 12-14) PC (bits 16-19) as would be present by an interrupt */
 
   *regs++ = ((M16C_DEFAULT_IPL << 4) | ((uint32)tcb->start >> 16));
 
-  /* Offset 4: FLG (bits 0-7) */
+  /* Offset 1: FLG (bits 0-7) */
 
+#ifdef CONFIG_SUPPRESS_INTERRUPTS
+  *regs++ = M16C_FLG_U;
+#else
   *regs++ = M16C_FLG_U | M16C_FLG_I;
+#endif
 
-  /* Offset 5-6: 16-bit PC [0]:bits8-15 [1]:bits 0-7 */
+  /* Offset 2-3: 16-bit PC [0]:bits8-15 [1]:bits 0-7 */
 
   *regs++ = (uint32)tcb->start >> 8;  /* Bits 8-15 of PC */
   *regs++ = (uint32)tcb->start;       /* Bits 0-7 of PC */
+
+  /* Offset 18-20: User stack pointer */
+
+   regs   = &xcp->regs[REG_SP];
+  *regs++ = (uint32)tcb->adj_stack_ptr >> 8;  /* Bits 8-15 of SP */
+  *regs   = (uint32)tcb->adj_stack_ptr;       /* Bits 0-7 of SP */
 }
diff --git a/nuttx/arch/sh/src/m16c/m16c_vectors.S b/nuttx/arch/sh/src/m16c/m16c_vectors.S
index 2aec1ab8d..2ffa50154 100644
--- a/nuttx/arch/sh/src/m16c/m16c_vectors.S
+++ b/nuttx/arch/sh/src/m16c/m16c_vectors.S
@@ -38,6 +38,7 @@
  ************************************************************************************/
 
 #include <nuttx/config.h>
+#include <arch/irq.h>
 #include "chip.h"
 
 /************************************************************************************
@@ -48,6 +49,15 @@
  * Macro Definitions
  ************************************************************************************/
 
+/* Select register bank 1, and pass the IRQ number to _m16c_commonvector */
+
+	.macro	m16c_vector, label, irqno
+\label:
+	fset	b
+	mov.w	#\irqno, r1
+	jmp.w	_m16c_commonvector
+	.endm
+
 /* Special page vectors. This macro puts the jump address of	
  * functions defined as special page into the special page vector table.
  * See example calls below and see the M16C Software Manual or NC30
@@ -72,142 +82,79 @@
 /* Variable vector section */
 
 	.section varvects			/* Variable vector table */
-	.globl	_m16c_unexpected_isr
-	.globl	_m16c_brk_isr
 	.long	_m16c_brk_isr			/* ffd00: BRK instruction */
 	.long	0xffffffff			/* ffd04 */
 	.long	0xffffffff			/* ffd08 */
 	.long	0xffffffff			/* ffd0c */
-	.globl	_m16c_int3_isr
 	.long	_m16c_int3_isr			/* ffd10: INT3 */
+	.long	_m16c_contextsave		/* ffd14: Reserved -- SWINT5 used by NuttX */
 #ifdef CONFIG_M16C_SWINTS
-	.globl	_m16c_swint5_isr
-	.long	_m16c_swint5_isr		/* ffd14: S/W interrupt 5 */
-	.globl	_m16c_swint6_isr
-	.long	_m16c_swint6_isr		/* ffd18: S/W interrupt 6 */
-	.globl	_m16c_swint7_isr
+	.long	_m16c_swint6_isr		/* ffd18: S/W interrupt 7 */
 	.long	_m16c_swint7_isr		/* ffd1c: S/W interrupt 7 */
 #else
-	.long	_m16c_unexpected_isr		/* ffd14: Reserved */
-	.long	_m16c_unexpected_isr		/* ffd18: Reserved */
+	.long	_m16c_unexpected_isr		/* ffd1c: Reserved */
 	.long	_m16c_unexpected_isr		/* ffd1c: Reserved */
 #endif
-	.globl	_m16c_int5_isr
 	.long	_m16c_int5_isr			/* ffd20: INT5 */
-	.globl	_m16c_int4_isr
 	.long	_m16c_int4_isr			/* ffd24: INT4 */
-	.globl	_m16c_uart2bcd_isr
 	.long	_m16c_uart2bcd_isr		/* ffd28: UART2 bus collision detection */
-	.globl	_m16c_dma0_isr
 	.long	_m16c_dma0_isr			/* ffd2c: DMA0 */
-	.globl	_m16c_dma1_isr
 	.long	_m16c_dma1_isr			/* ffd30: DMA1 */
-	.globl	_m16c_keyinp_isr
 	.long	_m16c_keyinp_isr		/* ffd34: Key input interrupt */
-	.globl	_m16c_adc_isr
 	.long	_m16c_adc_isr			/* ffd38: A-D */
-	.globl	_m16c_uart2xmitnack2_isr
 	.long	_m16c_uart2xmitnack2_isr	/* ffd3c UART2 transmit/NACK2 */
-	.globl	_m16c_uart2rcvack2_isr
 	.long	_m16c_uart2rcvack2_isr		/* ffd40: UART2 receive/ACK2 */
-	.globl	_m16c_uart0xmit_isr
 	.long	_m16c_uart0xmit_isr		/* ffd44: UART0 transmit */
-	.globl	_m16c_uart0rcv_isr
 	.long	_m16c_uart0rcv_isr		/* ffd48: UART0 receive */
-	.globl	_m16c_uart1xmit_isr
 	.long	_m16c_uart1xmit_isr		/* ffd4c: UART1 transmit */
-	.globl	_m16c_uart1rcv_isr
 	.long	_m16c_uart1rcv_isr		/* ffd50: UART1 receive */
-	.globl	_m16c_tmra0_isr
 	.long	_m16c_tmra0_isr			/* ffd54: Timer A0 */
-	.globl	_m16c_tmra1_isr
 	.long	_m16c_tmra1_isr			/* ffd58: Timer A1 */
-	.globl	_m16c_tmra2_isr
 	.long	_m16c_tmra2_isr			/* ffd5c: Timer A2 */
-	.globl	_m16c_tmra3_isr
 	.long	_m16c_tmra3_isr			/* ffd60: Timer A3 */
-	.globl	_m16c_tmra4_isr
 	.long	_m16c_tmra4_isr			/* ffd64: Timer A4 */
-	.globl	_m16c_tmrb0_isr
 	.long	_m16c_tmrb0_isr			/* ffd68: Timer B0 */
-	.globl	_m16c_tmrb1_isr
 	.long	_m16c_tmrb1_isr			/* ffd6c: Timer B1 */
-	.globl	_m16c_tmrb2_isr
 	.long	_m16c_tmrb2_isr			/* ffd70: Timer B2 */
-	.globl	_m16c_int0_isr
 	.long	_m16c_int0_isr			/* ffd74: INT0 */
-	.globl	_m16c_int1_isr
 	.long	_m16c_int1_isr			/* ffd78: INT1 */
 #ifdef CONFIG_M16C_SWINTS
-	.globl	_m16c_swint31_isr
 	.long	_m16c_swint31_isr		/* ffd7c: S/W interrupt 31 */
-	.globl	_m16c_swint32_isr
-	.long	_m16c_swint32_isr		/* ffd80: S/W interrupt 32 */
-	.globl	_m16c_swint33_isr
+	.long	_m16c_contextrestore		/* ffd80: S/W interrupt 32 by NuttX */
 	.long	_m16c_swint33_isr		/* ffd84: S/W interrupt 33 */
-	.globl	_m16c_swint34_isr
 	.long	_m16c_swint34_isr		/* ffd88: S/W interrupt 34 */
-	.globl	_m16c_swint35_isr
 	.long	_m16c_swint35_isr		/* ffd8c: S/W interrupt 35 */
-	.globl	_m16c_swint36_isr
 	.long	_m16c_swint36_isr		/* ffd90: S/W interrupt 36 */
-	.globl	_m16c_swint37_isr
 	.long	_m16c_swint37_isr		/* ffd94: S/W interrupt 37 */
-	.globl	_m16c_swint38_isr
 	.long	_m16c_swint38_isr		/* ffd98: S/W interrupt 38 */
-	.globl	_m16c_swint39_isr
 	.long	_m16c_swint39_isr		/* ffd9c: S/W interrupt 39 */
-	.globl	_m16c_swint40_isr
 	.long	_m16c_swint40_isr		/* ffda0: S/W interrupt 40 */
-	.globl	_m16c_swint41_isr
 	.long	_m16c_swint41_isr		/* ffda4: S/W interrupt 41 */
-	.globl	_m16c_swint42_isr
 	.long	_m16c_swint42_isr		/* ffda8: S/W interrupt 42 */
-	.globl	_m16c_swint43_isr
 	.long	_m16c_swint43_isr		/* ffdac: S/W interrupt 43 */
-	.globl	_m16c_swint44_isr
 	.long	_m16c_swint44_isr		/* ffdb0: S/W interrupt 44 */
-	.globl	_m16c_swint45_isr
 	.long	_m16c_swint45_isr		/* ffdb4: S/W interrupt 45 */
-	.globl	_m16c_swint46_isr
 	.long	_m16c_swint46_isr		/* ffdb8: S/W interrupt 46 */
-	.globl	_m16c_swint47_isr
 	.long	_m16c_swint47_isr		/* ffdbc: S/W interrupt 47 */
-	.globl	_m16c_swint48_isr
 	.long	_m16c_swint48_isr		/* ffdc0: S/W interrupt 48 */
-	.globl	_m16c_swint49_isr
 	.long	_m16c_swint49_isr		/* ffdc4: S/W interrupt 49 */
-	.globl	_m16c_swint50_isr
 	.long	_m16c_swint50_isr		/* ffdc8: S/W interrupt 50 */
-	.globl	_m16c_swint51_isr
 	.long	_m16c_swint51_isr		/* ffdcc: S/W interrupt 51 */
-	.globl	_m16c_swint52_isr
 	.long	_m16c_swint52_isr		/* ffdd0: S/W interrupt 52 */
-	.globl	_m16c_swint53_isr
 	.long	_m16c_swint53_isr		/* ffdd4: S/W interrupt 53 */
-	.globl	_m16c_swint54_isr
 	.long	_m16c_swint54_isr		/* ffdd8: S/W interrupt 54 */
-	.globl	_m16c_swint55_isr
 	.long	_m16c_swint55_isr		/* ffddc: S/W interrupt 55 */
-	.globl	_m16c_swint56_isr
 	.long	_m16c_swint56_isr		/* ffde0: S/W interrupt 56 */
-	.globl	_m16c_swint57_isr
 	.long	_m16c_swint57_isr		/* ffde4: S/W interrupt 57 */
-	.globl	_m16c_swint58_isr
 	.long	_m16c_swint58_isr		/* ffde8: S/W interrupt 58 */
-	.globl	_m16c_swint59_isr
 	.long	_m16c_swint59_isr		/* ffdec: S/W interrupt 59 */
-	.globl	_m16c_swint60_isr
 	.long	_m16c_swint60_isr		/* ffdf0: S/W interrupt 60 */
-	.globl	_m16c_swint61_isr
 	.long	_m16c_swint61_isr		/* ffdf4: S/W interrupt 61 */
-	.globl	_m16c_swint62_isr
 	.long	_m16c_swint62_isr		/* ffdf8: S/W interrupt 62 */
-	.globl	_m16c_swint63_isr
 	.long	_m16c_swint63_isr		/* ffdfc: S/W interrupt 63 */
 #else
 	.long	_m16c_unexpected_isr		/* ffd7c: Reserved */
-	.long	_m16c_unexpected_isr		/* ffd80: Not supported */
+	.long	_m16c_contextrestore		/* ffd80: S/W interrupt 32 by NuttX */
 	.long	_m16c_unexpected_isr		/* ffd84: Not supported */
 	.long	_m16c_unexpected_isr		/* ffd88: Not supported */
 	.long	_m16c_unexpected_isr		/* ffd8c: Not supported */
@@ -248,31 +195,23 @@
  * is not currently used.
  */
  	.section specpg				/* Special page table */
- 
+ /* Nothing */
 	.section fixvects			/* Fixed vector table */
-	.globl	_m16c_undefinst_irq
 	.long	_m16c_undefinst_irq		/* fffdc: Undefined instruction */
-	.globl	_m16c_overflow_irq
 	.long	_m16c_overflow_irq		/* fffe0: Overflow */
-	.globl	_m16c_brkinst_irq
 	.long	_m16c_brkinst_irq		/* fffe4: BRK instruction */
-	.globl	_m16c_addrmatch_irq
 	.long	_m16c_addrmatch_irq		/* fffe8: Address match */
 #ifdef CONFIG_M16C_DEBUGGER
-	.globl	_m16c_sstep_irq
 	.long	_m16c_sstep_irq			/* fffec: Single step */
 #else
 	.long	_m16c_unexpected_isr		/* fffec: Not supported */
 #endif
-	.globl	_m16c_wdog_irq
 	.long	_m16c_wdog_irq			/* ffff0: Watchdog timer */
 #ifdef CONFIG_M16C_DEBUGGER
-	.globl	_m16c_dbc_irq
 	.long	_m16c_dbc_irq			/* ffff4: DBC */
 #else
 	.long	_m16c_unexpected_isr		/* ffff4: Not supported */
 #endif
-	.globl	_m16c_nmi_irq
 	.long	_m16c_nmi_irq			/* ffff8: NMI */
 	.long	__start				/* ffffc: Reset */
 
@@ -280,15 +219,15 @@
  * Code
  ************************************************************************************/
 /************************************************************************************
- * Name: 
+ * Name: m16c_*isr
  *
  * Description:
- *   The M16C has a push down stack.  The CPU performs the following actions when an
+ *   Handler interrupt events. The CPU performs the following actions when an
  *   interrupt is taken:
  *
- *  - Save FLG regsiter
+ *  - Save FLG register
  *  - Clear I, D, and U flags in FLG register
- *  - Builds stack frame like:
+ *  - Builds stack frame like (on the push-down, interrupt stack):
  * 
  *    sp   -> PC bits 0-7
  *    sp+1 -> PC bits 8-15
@@ -301,4 +240,273 @@
  ************************************************************************************/
 
  	.text
+/* The unexpected interrupt vector */
+
+ 	m16c_vector	_m16c_unexpected_isr, NR_IRQS
+
+ /* Variable vectors */
+ 
+	m16c_vector	_m16c_brk_isr, M16C_BRK_IRQ
+	m16c_vector	_m16c_int3_isr, M16C_INT3_IRQ
+	m16c_vector	_m16c_int5_isr, M16C_INT5_IRQ
+	m16c_vector	_m16c_int4_isr, M16C_INT4_IRQ
+	m16c_vector	_m16c_uart2bcd_isr, M16C_UART2BCD_IRQ
+	m16c_vector	_m16c_dma0_isr, M16C_DMA0_IRQ
+	m16c_vector	_m16c_dma1_isr, M16C_DMA1_IRQ
+	m16c_vector	_m16c_keyinp_isr, M16C_KEYINP_IRQ
+	m16c_vector	_m16c_adc_isr, M16C_ADC_IRQ
+	m16c_vector	_m16c_uart2xmitnack2_isr, M16C_UARTXNAK_IRQ
+	m16c_vector	_m16c_uart2rcvack2_isr, M16C_UARTRACK_IRQ
+	m16c_vector	_m16c_uart0xmit_isr, M16C_UART0XMT_IRQ
+	m16c_vector	_m16c_uart0rcv_isr, M16C_UART0RCV_IRQ
+	m16c_vector	_m16c_uart1xmit_isr, M16C_UART1XMT_IRQ
+	m16c_vector	_m16c_uart1rcv_isr, M16C_UART1RCV_IRQ
+	m16c_vector	_m16c_tmra0_isr, M16C_TMRA0_IRQ
+	m16c_vector	_m16c_tmra1_isr, M16C_TMRA1_IRQ
+	m16c_vector	_m16c_tmra2_isr, M16C_TMRA2_IRQ
+	m16c_vector	_m16c_tmra3_isr, M16C_TMRA3_IRQ
+	m16c_vector	_m16c_tmra4_isr, M16C_TMRA4_IRQ
+	m16c_vector	_m16c_tmrb0_isr, M16C_TMRB0_IRQ
+	m16c_vector	_m16c_tmrb1_isr, M16C_TMRB1_IRQ
+	m16c_vector	_m16c_tmrb2_isr, M16C_TMRB2_IRQ
+	m16c_vector	_m16c_int0_isr, M16C_INT0_IRQ
+	m16c_vector	_m16c_int1_isr, M16C_INT1_IRQ
+
+#ifdef CONFIG_M16C_SWINTS
+	m16c_vector	_m16c_swint5_isr, M16C_SWINT5_IRQ
+	m16c_vector	_m16c_swint6_isr, M16C_SWINT6_IRQ
+	m16c_vector	_m16c_swint7_isr, M16C_SWINT7_IRQ
+	m16c_vector	_m16c_swint31_isr, M16C_SWINT31_IRQ
+	m16c_vector	_m16c_swint32_isr, M16C_SWINT32_IRQ
+	m16c_vector	_m16c_swint33_isr, M16C_SWINT33_IRQ
+	m16c_vector	_m16c_swint34_isr, M16C_SWINT34_IRQ
+	m16c_vector	_m16c_swint35_isr, M16C_SWINT35_IRQ
+	m16c_vector	_m16c_swint36_isr, M16C_SWINT36_IRQ
+	m16c_vector	_m16c_swint37_isr, M16C_SWINT37_IRQ
+	m16c_vector	_m16c_swint38_isr, M16C_SWINT38_IRQ
+	m16c_vector	_m16c_swint39_isr, M16C_SWINT39_IRQ
+	m16c_vector	_m16c_swint40_isr, M16C_SWINT40_IRQ
+	m16c_vector	_m16c_swint41_isr, M16C_SWINT41_IRQ
+	m16c_vector	_m16c_swint42_isr, M16C_SWINT42_IRQ
+	m16c_vector	_m16c_swint43_isr, M16C_SWINT43_IRQ
+	m16c_vector	_m16c_swint44_isr, M16C_SWINT44_IRQ
+	m16c_vector	_m16c_swint45_isr, M16C_SWINT45_IRQ
+	m16c_vector	_m16c_swint46_isr, M16C_SWINT46_IRQ
+	m16c_vector	_m16c_swint47_isr, M16C_SWINT47_IRQ
+	m16c_vector	_m16c_swint48_isr, M16C_SWINT48_IRQ
+	m16c_vector	_m16c_swint49_isr, M16C_SWINT49_IRQ
+	m16c_vector	_m16c_swint50_isr, M16C_SWINT50_IRQ
+	m16c_vector	_m16c_swint51_isr, M16C_SWINT51_IRQ
+	m16c_vector	_m16c_swint52_isr, M16C_SWINT52_IRQ
+	m16c_vector	_m16c_swint53_isr, M16C_SWINT53_IRQ
+	m16c_vector	_m16c_swint54_isr, M16C_SWINT54_IRQ
+	m16c_vector	_m16c_swint55_isr, M16C_SWINT55_IRQ
+	m16c_vector	_m16c_swint56_isr, M16C_SWINT56_IRQ
+	m16c_vector	_m16c_swint57_isr, M16C_SWINT57_IRQ
+	m16c_vector	_m16c_swint58_isr, M16C_SWINT58_IRQ
+	m16c_vector	_m16c_swint59_isr, M16C_SWINT59_IRQ
+	m16c_vector	_m16c_swint60_isr, M16C_SWINT60_IRQ
+	m16c_vector	_m16c_swint61_isr, M16C_SWINT61_IRQ
+	m16c_vector	_m16c_swint62_isr, M16C_SWINT62_IRQ
+	m16c_vector	_m16c_swint63_isr, M16C_SWINT63_IRQ
+#endif
+
+/* Fixed vectors */
+
+	m16c_vector	_m16c_undefinst_irq, M16C_UNDEFINST_IRQ
+	m16c_vector	_m16c_overflow_irq, M16C_OVERFLOW_IRQ
+	m16c_vector	_m16c_brkinst_irq, M16C_BRK_IRQ
+	m16c_vector	_m16c_addrmatch_irq, M16C_ADDRMATCH_IRQ
+	m16c_vector	_m16c_wdog_irq, M16C_WDOG_IRQ
+	m16c_vector	_m16c_nmi_irq, M16C_NMI_IRQ
+#ifdef CONFIG_M16C_DEBUGGER
+	m16c_vector	_m16c_sstep_irq, M16C_SSTEP_IRQ
+	m16c_vector	_m16c_dbc_irq, M16C_DBC_IRQ
+#endif
+
+/* At this point, the stack remains as it was on interrupt.  The interrupt
+ * stack is selected, register bank 1 is selected and r1 holds the IRQ
+ * number.
+ */
+
+_m16c_commonvector:
+
+/* At this point, the interrupt stack has 4 bytes of info on it. */
+
+/* Save all registers on the interrupt stack */
+
+	fclr	b				/* Switch back to Bank 0 */
+	pushm	fb,sb,a1,a0,r3,r2,r1,r0		/* Save on interrupt stack */
+	fset	b				/* Bank to bank 1 */
+
+/* Save the user stack pointer on the interrupt stack */
+
+	fset	u				/* Switch to User stack */
+	stc	sp, r0				/* R0 = user stack pointer */
+	fclr	u				/* Back to interrupt stack */
+	push.w	r0				/* Save user sp on isp */
+
+/* Then call _up_doirq with r1=IRQ number, r2=address of context info.  At this
+ * point, the interrupt stack holds the address of the last byte of the context
+ * info array
+ */
+
+ 	stc	isp, r2				/* R2 = address of base of context info */
+	jsr.a	_up_doirq
+
+/* Upon return, r0 will hold address of the base of the new context info structure
+ * use for return.  Most of the time this will be the same as the address passed to
+ * to _up_doirg above, but will differ if a context switch occurs during interrupt
+ * processing.
+ *
+ * Of the ISP to the end of the context array:
+ */
+ 
+ 	ldc	r0, isp				/* ISP = address of base of new context info */
+ 
+ /* Restore the user stack pointer */
+ 
+ 	pop.w	r0				/* R0 = saved user stack pointer */
+	fset	u				/* Switch to User stack */
+	ldc	r0, sp				/* Restore the user stack pointer */
+	fclr	u				/* Back to interrupt stack */
+ 	
+/* Recover all registers and return */
+
+	fclr	b				/* Switch back to Bank 0 */
+	popm	fb,sb,a1,a0,r3,r2,r1,r0		/* Recover registers */
+	reit					/* Return from interrupt */
+
+/************************************************************************************
+ * Name: int up_saveusercontext(uint32 *regs)
+ *
+ * Description:
+ *   Save the context of the calling function at the point of the return from the
+ *   call.  This basically a setjmp.
+ *
+ * Input Parameters:
+ *   R1 = Address of register save array
+ *
+ * Returned Value:
+ *   R0 = 0 on normal call; 1 on context switch
+ *
+ ************************************************************************************/
+
+	.globl	_up_saveusercontext
+	.type	_up_saveusercontext, #function
+
+_up_saveusercontext:
+	int	#5		/* Execute S/W interrupt 5 */
+	rts			/* Then return with the correct value in r0 */
+
+/* This the logic executes in response to S/W interrupt 5.  The 'int 5' instruction
+ * will cause the following actions:
+ *
+ *  - Save FLG register
+ *  - Clear I, D, and U flags in FLG register
+ *  - Builds stack frame like (on the push-down, interrupt stack):
+ * 
+ *    sp   -> PC bits 0-7
+ *    sp+1 -> PC bits 8-15
+ *    sp+2 -> FLG bits 0-7
+ *    sp+3 -> FLG (Bits 12-14) + PC (bits 16-19)
+ *
+ *  - Set IPL
+ *  - Vectors to this S/W interrupt handler:
+ */
+
+_m16c_contextsave:
+
+/* Save all registers on the interrupt stack */
+
+	mov.w	#1, r0				/* Return 1 on context switch */
+	pushm	fb,sb,a1,a0,r3,r2,r1,r0		/* Save on interrupt stack */
+
+/* Save the user stack pointer on the interrupt stack */
+
+	fset	u				/* Switch to User stack */
+	stc	sp, r0				/* R0 = user stack pointer */
+	fclr	u				/* Back to interrupt stack */
+	push.w	r0				/* Save user sp on isp */
+
+/* Then copy the stack content to the register context array pointed to by r1 */
+
+ 	stc	isp, a0				/* A0 = address of base of context info */
+	mov.w	r1, a1				/* A1 = address of register context array */
+	mov.b	#0, r1h				/* R1H = 4 MS of 20-bit source address */
+	mov.w	#XCPTCONTEXT_SIZE, r3		/* R3 = Number of bytes to transfer */
+	smovf.b					/* Copy ISP to near context array */
+
+/* Then return zero to indicate a normal function call return */
+
+	add.w	#(XCPTCONTEXT_SIZE - 4), sp	/* Remove stuff from stack */
+	mov.w	#0, r0				/* Return zero */
+	reit					/* Return from interrupt */
+	.size	_up_saveusercontext, .-_up_saveusercontext
+	
+/************************************************************************************
+ * Name: void up_fullcontextrestore(uint32 *regs)
+ *
+ * Description:
+ *   Restore the context of the using the provided register save array.
+ *
+ * Input Parameters:
+ *   R1 = Address of register save array
+ *
+ * Returned Value:
+ *   None
+ *
+ ************************************************************************************/
+
+	.globl	_up_fullcontextrestore
+	.type	_up_fullcontextrestore, #function
+
+_up_fullcontextrestore:
+	int	#32		/* Execute S/W interrupt 32 */
+	rts			/* and return */
+
+/* This the logic executes in response to S/W interrupt 32.  The 'int 32' instruction
+ * will cause the following actions:
+ *
+ *  - Save FLG register
+ *  - Clear I and D flags in FLG register (U is preserved)
+ *  - Builds stack frame like (on the push-down, interrupt stack):
+ * 
+ *    sp   -> PC bits 0-7
+ *    sp+1 -> PC bits 8-15
+ *    sp+2 -> FLG bits 0-7
+ *    sp+3 -> FLG (Bits 12-14) + PC (bits 16-19)
+ *
+ *  - Set IPL
+ *  - Vectors to this S/W interrupt handler:
+ */
+
+_m16c_contextrestore:
+
+/* Set the USP to the beginning of the context save area */
+
+ 	ldc	r1, sp				/* USP = address of base of new context info */
+ 
+ /* Restore the user stack pointer */
+ 
+ 	fset	b				/* Switch to bank 1 */
+ 	pop.w	r0				/* R0 = saved user stack pointer */
+	fclr	b				/* Back to bank 0 */
+ 	
+/* Recover all registers */
+
+	popm	fb,sb,a1,a0,r3,r2,r1,r0		/* Restore from registers from user stack */
+
+/* Set the USP and return */
+
+	fset	b				/* Switch to bank 1 */
+	popm	r1,r0				/* Recover the PC and flags */
+	stc	sp, r0				/* Set the correct USP */
+	pushm	r1,r0				/* Put the PC and flags */
+	fclr	b				/* Back to bank 0 */
+
+/* The return from interrupt */
+
+	reit					/* Return from interrupt */
+	.size	_up_fullcontextrestore, .-_up_fullcontextrestore
 	.end