!372 [本次提交内容：在TI公司C6000 DSP处理器上成功移植rt-thread操作系统；主要在libcpu/ti-dsp/c6x添加keystone架构底层代码，在bsp/ti-c6678添加bsp工程，该工程已在本人的开发板上成功运行]

Merge pull request !372 from hdwei/hdwei

12 files changed, 1941 insertions, 0 deletions

diff --git a/libcpu/ti-dsp/c6x/SConscript b/libcpu/ti-dsp/c6x/SConscript
new file mode 100644
index 0000000000..0fe94fd9a6
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/SConscript
@@ -0,0 +1,14 @@
+# RT-Thread building script for component
+
+from building import *
+
+Import('rtconfig')
+
+cwd     = GetCurrentDir()
+src     = Glob('*.c') + Glob('*.cpp') + Glob('*.asm')
+CPPPATH = [cwd]
+ASFLAGS = ''
+
+group = DefineGroup('CPU', src, depend = [''], CPPPATH = CPPPATH, ASFLAGS = ASFLAGS)
+
+Return('group')
diff --git a/libcpu/ti-dsp/c6x/c66xx.h b/libcpu/ti-dsp/c6x/c66xx.h
new file mode 100644
index 0000000000..b69561c163
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/c66xx.h
@@ -0,0 +1,98 @@
+/*
+ * Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2021-11-16     Dystopia     the first version
+ */
+
+#ifndef __C66XX_H__
+#define __C66XX_H__
+
+extern __cregister volatile unsigned int IERR;    /* Internal Exception Report Register */
+extern __cregister volatile unsigned int ECR;     /* Exception Clear Register */
+extern __cregister volatile unsigned int EFR;     /* Exception Flag Register */
+extern __cregister volatile unsigned int TSR;     /* Task State Register */
+extern __cregister volatile unsigned int ITSR;    /* Interrupt Task State Register */
+extern __cregister volatile unsigned int NTSR;    /* NMI/exception Task State Register */
+extern __cregister volatile unsigned int TSCL;    /* Time Stamp Counter Register - Low Half  */
+extern __cregister volatile unsigned int TSCH;    /* Time Stamp Counter Register - High Half */
+extern __cregister volatile unsigned int DNUM;    /* Core number */
+
+extern __cregister volatile unsigned int AMR;
+extern __cregister volatile unsigned int CSR;
+extern __cregister volatile unsigned int IFR;
+extern __cregister volatile unsigned int ISR;
+extern __cregister volatile unsigned int ICR;
+extern __cregister volatile unsigned int IER;
+extern __cregister volatile unsigned int ISTP;
+extern __cregister volatile unsigned int IRP;
+extern __cregister volatile unsigned int NRP;
+
+#ifdef _BIG_ENDIAN
+#define RT_REG_PAIR(odd, even) unsigned long odd; unsigned long even
+#else
+#define RT_REG_PAIR(odd, even) unsigned long even; unsigned long odd
+#endif
+
+struct rt_hw_register
+{
+    RT_REG_PAIR(b17, b16);
+    RT_REG_PAIR(b19, b18);
+    RT_REG_PAIR(b21, b20);
+    RT_REG_PAIR(b23, b22);
+    RT_REG_PAIR(b25, b24);
+    RT_REG_PAIR(b27, b26);
+    RT_REG_PAIR(b29, b28);
+    RT_REG_PAIR(b31, b30);
+
+    RT_REG_PAIR(b1, b0);
+    RT_REG_PAIR(b3, b2);
+    RT_REG_PAIR(b5, b4);
+    RT_REG_PAIR(b7, b6);
+    RT_REG_PAIR(b9, b8);
+    RT_REG_PAIR(b11, b10);
+    RT_REG_PAIR(b13, b12);
+    
+    RT_REG_PAIR(a17, a16);
+    RT_REG_PAIR(a19, a18);
+    RT_REG_PAIR(a21, a20);
+    RT_REG_PAIR(a23, a22);
+    RT_REG_PAIR(a25, a24);
+    RT_REG_PAIR(a27, a26);
+    RT_REG_PAIR(a29, a28);
+    RT_REG_PAIR(a31, a30);
+
+    RT_REG_PAIR(a1, a0);
+    RT_REG_PAIR(a3, a2);
+    RT_REG_PAIR(a5, a4);
+    RT_REG_PAIR(a7, a6);
+    RT_REG_PAIR(a9, a8);
+    RT_REG_PAIR(a11, a10);
+    RT_REG_PAIR(a13, a12);
+
+    RT_REG_PAIR(a15, a14);
+    RT_REG_PAIR(sp, dp);
+};
+    
+typedef struct rt_hw_exp_stack_register
+{
+    RT_REG_PAIR(tsr, orig_a4);
+    RT_REG_PAIR(rilc, ilc);
+    RT_REG_PAIR(pc, csr);
+    struct rt_hw_register hw_register;
+} rt_hw_thread_stack_register;
+
+#define __dint()                asm(" DINT")
+#define __rint()                asm(" RINT")
+#define __system_call()         asm(" SWE")
+#define __enter_idle()          asm(" IDLE")
+#define __nop()                 asm(" NOP")
+#define __mfence()              asm(" MFENCE")
+
+#define __SYSREG(ADDR, TYPE)    (*(volatile TYPE*)(ADDR))
+#define __SYSREGA(ADDR, TYPE)   ((volatile TYPE*)(ADDR))
+
+#endif /* __C66XX_H__ */
diff --git a/libcpu/ti-dsp/c6x/context.asm b/libcpu/ti-dsp/c6x/context.asm
new file mode 100644
index 0000000000..aa7a138887
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/context.asm
@@ -0,0 +1,351 @@
+;
+; Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+;
+; SPDX-License-Identifier: Apache-2.0
+;
+; Change Logs:
+; Date           Author       Notes
+; 2021-11-16     Dystopia     the first version
+;
+
+;-----------------------------------------------------------
+;               context switch for C6000 DSP
+;-----------------------------------------------------------
+
+	.include "contextinc.asm"
+;-----------------------------------------------------------
+;                      macro definition
+;-----------------------------------------------------------
+DP	.set	B14
+SP	.set	B15
+;
+;-----------------------------------------------------------
+;
+
+;-----------------------------------------------------------
+;                      global variable
+;-----------------------------------------------------------
+	.global	rt_interrupt_from_thread
+	.global	rt_interrupt_to_thread
+	.global	rt_thread_switch_interrupt_flag
+;
+;-----------------------------------------------------------
+;
+    .sect   ".text"
+;-----------------------------------------------------------
+; void rt_hw_enable_exception(void)
+;-----------------------------------------------------------
+	.global	rt_hw_enable_exception
+rt_hw_enable_exception:
+	DINT
+	MVC	.S2	TSR,B0
+	MVC	.S2	B3,NRP
+	MVK	.L2	0xC,B1
+	OR	.D2	B0,B1,B0
+	MVC	.S2	B0,TSR    ; Set GEE and XEN in TSR
+	B	.S2	NRP
+	NOP	5
+
+;-----------------------------------------------------------
+; rt_base_t rt_hw_interrupt_enable(void)
+;-----------------------------------------------------------
+	.global	rt_hw_interrupt_disable
+rt_hw_interrupt_disable:
+;{
+	MVC	CSR,B4
+	MV	B4,A4
+	AND	1,B4,B0
+ [!B0]	CLR B4,1,1,B4
+ [B0]	SET B4,1,1,B4
+	CLR B4,0,0,B4
+	MVC B4,CSR
+	B 	B3
+	NOP	5
+;}
+
+;-----------------------------------------------------------
+; void rt_hw_interrupt_enable(rt_base_t scr)
+;-----------------------------------------------------------
+	.global	rt_hw_interrupt_enable
+rt_hw_interrupt_enable:
+;{
+	MVC	A4,CSR
+	B	B3
+	NOP 5
+;}
+
+;-----------------------------------------------------------
+; rt_uint32_t rt_hw_get_current_dp(void)
+;-----------------------------------------------------------
+	.global	rt_hw_get_current_dp
+rt_hw_get_current_dp:
+;{
+	B	B3
+	MV	B14,	A4
+	NOP	4
+;}
+
+;-----------------------------------------------------------
+; rt_int32_t __fls(rt_int32_t val)
+;-----------------------------------------------------------
+	.global __fls
+__fls:
+;{
+    B	B3
+	LMBD  .L1  1,A4,A4
+	NOP	4
+;}
+
+;-----------------------------------------------------------
+; rt_int32_t __ffs(rt_int32_t val)
+;-----------------------------------------------------------
+	.global __ffs
+__ffs:
+;{
+	BITR  .M1  A4,A4
+	B	B3
+	LMBD  .L1  1,A4,A4
+	NOP	4
+;}
+
+;
+;-----------------------------------------------------------
+;
+
+;
+; void rt_hw_context_switch(rt_uint32 from, rt_uint32 to);
+; A4 --> from
+; B4 --> to
+;
+	.global	rt_hw_context_switch
+rt_hw_context_switch:
+; {
+	SUBAW	.D2	SP,2,SP
+	ADD	.D1X	SP,-8,A15
+ ||	STDW	.D2T1	A15:A14,*SP--[3]    ; Store A15:A14
+
+	STDW	.D2T2	B13:B12,*SP--[1]    ; Store B13:B12
+ ||	STDW	.D1T1	A13:A12,*A15--[1]   ; Store A13:A12
+ ||	MV		B3,B13
+	STDW	.D2T2	B11:B10,*SP--[1]    ; Store B11:B10
+ ||	STDW	.D1T1	A11:A10,*A15--[1]   ; Store A11:A10
+ ||	MVC	.S2	CSR,B12
+	STDW	.D2T2	B13:B12,*SP--[1]    ; Store PC:CSR
+ ||	MVC	.S2	TSR,B5
+
+	MVC	.S2	ILC,B11
+	MVC	.S2	RILC,B10
+	STDW	.D2T2	B11:B10,*SP--[1]    ; Store RILC:ILC
+ ||	MV	.S1X	B5,A3
+
+	ZERO	A2                          ;
+	STDW	.D2T1	A3:A2,*SP--[1]      ; Store TSR:stack type
+	STW	SP,*A4                          ; Save thread's stack pointer
+	B	rt_hw_context_switch_to
+	MV	B4,A4
+	NOP	4
+;}
+
+;
+; void rt_hw_context_switch_to(rt_uint32 to);
+; A4 --> to
+;
+	.global	rt_hw_context_switch_to
+rt_hw_context_switch_to:
+;{
+	LDW	*A4,SP
+	NOP	4
+	LDDW	.D2T2	*++SP[1],B9:B8      ; get TSR (B9) and stack frame type (B8)
+	LDDW	.D2T2	*++SP[1],B11:B10    ; get RILC (B11) and ILC (B10)
+	LDDW	.D2T2	*++SP[1],B13:B12    ; get PC (B13) and CSR (B12)
+	NOP	2
+	MV	B8,B0
+ [B0]  BNOP	_rt_thread_interrupt_stack, 5
+;
+; this maybe do better
+;
+	LDDW	.D2T2	*++SP[1],B11:B10
+ || MVC	.S2	B11,RILC                    ; Restore RILC
+  	LDDW	.D2T2	*++SP[1],B13:B12
+ ||	MVC	.S2	B10,ILC                     ; Restore ILC
+	LDDW	.D2T1	*++SP[1],A11:A10
+ ||	MV	B13,B3                          ; Restore PC
+	LDDW	.D2T1	*++SP[1],A13:A12
+ ||	MVC	.S2	B12,CSR                     ; Restore CSR
+	LDDW	.D2T1	*++SP[1],A15:A14
+	B	B3                              ; Return to caller
+	ADDAW	.D2	SP,2,SP
+	NOP	4                               ; Delay slots
+_rt_thread_interrupt_stack:
+	ADDAW	.D1X	SP,30,A15
+	LDDW	.D1T1	*++A15[1],A17:A16
+ ||	LDDW	.D2T2	*++SP[1],B17:B16
+	LDDW	.D1T1	*++A15[1],A19:A18
+ ||	LDDW	.D2T2	*++SP[1],B19:B18
+	LDDW	.D1T1	*++A15[1],A21:A20
+ ||	LDDW	.D2T2	*++SP[1],B21:B20
+	LDDW	.D1T1	*++A15[1],A23:A22
+ ||	LDDW	.D2T2	*++SP[1],B23:B22
+	LDDW	.D1T1	*++A15[1],A25:A24
+ ||	LDDW	.D2T2	*++SP[1],B25:B24
+	LDDW	.D1T1	*++A15[1],A27:A26
+ ||	LDDW	.D2T2	*++SP[1],B27:B26
+	LDDW	.D1T1	*++A15[1],A29:A28
+ ||	LDDW	.D2T2	*++SP[1],B29:B28
+	LDDW	.D1T1	*++A15[1],A31:A30
+ ||	LDDW	.D2T2	*++SP[1],B31:B30
+
+	LDDW	.D1T1	*++A15[1],A1:A0
+ ||	LDDW	.D2T2	*++SP[1],B1:B0
+
+	LDDW	.D1T1	*++A15[1],A3:A2
+ ||	LDDW	.D2T2	*++SP[1],B3:B2
+ ||	MVC	.S2	B9,ITSR	                    ; Restore ITSR
+	LDDW	.D1T1	*++A15[1],A5:A4
+ ||	LDDW	.D2T2	*++SP[1],B5:B4
+ ||	MVC	.S2	B11,RILC                    ; Restore RILC
+	LDDW	.D1T1	*++A15[1],A7:A6
+ ||	LDDW	.D2T2	*++SP[1],B7:B6
+ ||	MVC	.S2	B10,ILC                     ; Restore ILC
+
+	LDDW	.D1T1	*++A15[1],A9:A8
+ ||	LDDW	.D2T2	*++SP[1],B9:B8
+ ||	MVC	.S2	B13,IRP                     ; Restore IPR
+
+	LDDW	.D1T1	*++A15[1],A11:A10
+ ||	LDDW	.D2T2	*++SP[1],B11:B10
+ ||	MVC	.S2	B12,CSR                     ; Restore CSR
+
+	LDDW	.D1T1	*++A15[1],A13:A12
+ ||	LDDW	.D2T2	*++SP[1],B13:B12
+
+	MV	.D2X	A15,SP
+	LDDW	.D2T1	*++SP[1],A15:A14
+	B	IRP                             ; Return to point of interrupt
+	LDDW	.D2T2	*+SP[1],SP:DP
+	NOP	4                               ; Delay slots
+;}
+
+;
+;-----------------------------------------------------------
+;
+
+;
+; void rt_hw_context_switch_interrupt(rt_uint32_t from, rt_uint32_t to)
+; A4 --> from
+; B4 --> to
+;{
+	.global	rt_hw_context_switch_interrupt
+rt_hw_context_switch_interrupt:
+	SUB		B15,0x8,B15
+	STW		B4,*B15[2]
+	STW		A4,*B15[1]
+	LDW		*+B14(rt_thread_switch_interrupt_flag),B4
+	NOP		4
+	CMPEQ	1,B4,B0
+	[ B0]  BNOP	_reswitch,5
+	MVK		1,B4
+	STW		B4,*+B14(rt_thread_switch_interrupt_flag)
+	MV			A4,B4
+	STW		B4,*+B14(rt_interrupt_from_thread)
+_reswitch:
+	LDW		*B15[2],B4
+	NOP		4
+	STW		B4,*+B14(rt_interrupt_to_thread)
+	ADD		8,B15,B15
+	BNOP	B3,5
+;}
+
+;-----------------------------------------------------------
+;
+;void rt_interrupt_context_restore(void)
+;
+	.global	rt_interrupt_context_restore
+rt_interrupt_context_restore:
+;{
+	MVKL	rt_thread_switch_interrupt_flag,A3
+	MVKH	rt_thread_switch_interrupt_flag,A3
+	LDW		*A3,A1
+	NOP		4
+	CMPEQ	1,A1,A2
+ [A2]  BNOP	 rt_preempt_context_restore,5
+	LDDW	.D2T2	*++SP[1],B9:B8      ; get TSR (B9)
+	LDDW	.D2T2	*++SP[1],B11:B10    ; get RILC (B11) and ILC (B10)
+	LDDW	.D2T2	*++SP[1],B13:B12    ; get PC (B13) and CSR (B12)
+
+	ADDAW	.D1X	SP,30,A15
+
+	LDDW	.D1T1	*++A15[1],A17:A16
+ ||	LDDW	.D2T2	*++SP[1],B17:B16
+	LDDW	.D1T1	*++A15[1],A19:A18
+ ||	LDDW	.D2T2	*++SP[1],B19:B18
+	LDDW	.D1T1	*++A15[1],A21:A20
+ ||	LDDW	.D2T2	*++SP[1],B21:B20
+	LDDW	.D1T1	*++A15[1],A23:A22
+ ||	LDDW	.D2T2	*++SP[1],B23:B22
+	LDDW	.D1T1	*++A15[1],A25:A24
+ ||	LDDW	.D2T2	*++SP[1],B25:B24
+	LDDW	.D1T1	*++A15[1],A27:A26
+ ||	LDDW	.D2T2	*++SP[1],B27:B26
+	LDDW	.D1T1	*++A15[1],A29:A28
+ ||	LDDW	.D2T2	*++SP[1],B29:B28
+	LDDW	.D1T1	*++A15[1],A31:A30
+ ||	LDDW	.D2T2	*++SP[1],B31:B30
+
+	LDDW	.D1T1	*++A15[1],A1:A0
+ ||	LDDW	.D2T2	*++SP[1],B1:B0
+	LDDW	.D1T1	*++A15[1],A3:A2
+ ||	LDDW	.D2T2	*++SP[1],B3:B2
+ ||	MVC	.S2	B9,ITSR
+	LDDW	.D1T1	*++A15[1],A5:A4
+ ||	LDDW	.D2T2	*++SP[1],B5:B4
+ ||	MVC	.S2	B11,RILC
+	LDDW	.D1T1	*++A15[1],A7:A6
+ ||	LDDW	.D2T2	*++SP[1],B7:B6
+ ||	MVC	.S2	B10,ILC
+	LDDW	.D1T1	*++A15[1],A9:A8
+ ||	LDDW	.D2T2	*++SP[1],B9:B8
+ ||	MVC	.S2	B13,IRP
+
+	LDDW	.D1T1	*++A15[1],A11:A10
+ ||	LDDW	.D2T2	*++SP[1],B11:B10
+ ||	MVC	.S2	B12,CSR
+	LDDW	.D1T1	*++A15[1],A13:A12
+ ||	LDDW	.D2T2	*++SP[1],B13:B12
+
+	MV	.D2X	A15,SP
+ ||	MVKL	.S1	rt_system_stack_top,A15
+	MVKH	.S1	rt_system_stack_top,A15
+ ||	ADDAW	.D1X	SP,6,A14
+	STW	.D1T1	A14,*A15                ; save system stack pointer
+
+ 	LDDW	.D2T1	*++SP[1],A15:A14
+	B	.S2	IRP                         ; return from interruption
+	LDDW	.D2T2	*+SP[1],SP:DP
+	NOP		4
+rt_preempt_context_restore:
+	ZERO	A12
+	STW	A12,*A3                         ; clear rt_thread_switch_interrupt_flag
+;
+; restore saved registers by system stack
+;
+	RESTORE_ALL	IRP,ITSR
+;
+; store registers to thread stack
+;
+	THREAD_SAVE_ALL	IRP,ITSR
+
+    MVKL	rt_interrupt_from_thread,A11
+    MVKH	rt_interrupt_from_thread,A11
+    LDW		*A11,A10
+    NOP
+    MVKL	rt_interrupt_to_thread,B10
+    MVKH	rt_interrupt_to_thread,B10
+    LDW		*B10,B11
+    NOP		3
+    STW		SP,*A10                     ; store sp in preempted tasks's TCB
+    B		rt_hw_context_switch_to
+	MV		B11,A4
+	NOP		4
+;}
+	.end
diff --git a/libcpu/ti-dsp/c6x/contextinc.asm b/libcpu/ti-dsp/c6x/contextinc.asm
new file mode 100644
index 0000000000..3bc6afafc6
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/contextinc.asm
@@ -0,0 +1,192 @@
+;
+; Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+;
+; SPDX-License-Identifier: Apache-2.0
+;
+; Change Logs:
+; Date           Author       Notes
+; 2021-11-16     Dystopia     the first version
+;
+
+;-----------------------------------------------------------
+; 						extern variable
+;-----------------------------------------------------------
+	.ref rt_system_stack_top
+
+;-----------------------------------------------------------
+;                     macro definition
+;-----------------------------------------------------------
+SAVE_ALL	.macro  __rp, __tsr
+	STW	.D2T2	B0,*SP--[2]             ; save original B0
+	MVKL	.S2	rt_system_stack_top,B0
+	MVKH	.S2	rt_system_stack_top,B0
+	LDW	.D2T2	*B0,B1                  ; system stack
+
+	NOP	3
+	STW	.D2T2	B1,*+SP[1]              ; save original B1
+	XOR	.D2	SP,B1,B0                    ; check current stack types
+	LDW	.D2T2	*+SP[1],B1              ; restore B0/B1
+	LDW	.D2T2	*++SP[2],B0
+	SHR	.S2	B0,12,B0                    ; 0 if already using system stack
+ [B0]	STDW	.D2T2	SP:DP,*--B1[1]  ; thread: save thread sp/dp system stack
+ [B0]	MV	.S2	B1,SP                   ; and switch to system stack
+||[!B0] STDW	.D2T2	SP:DP,*--SP[1]  ; kernel: nest interrupt save(not support)
+
+	SUBAW	.D2	SP,2,SP
+
+	ADD	.D1X	SP,-8,A15
+ ||	STDW	.D2T1	A15:A14,*SP--[16]   ; save A15:A14
+
+	STDW	.D2T2	B13:B12,*SP--[1]
+ ||	STDW	.D1T1	A13:A12,*A15--[1]
+ ||	MVC	.S2	__rp,B13
+	STDW	.D2T2	B11:B10,*SP--[1]
+ ||	STDW	.D1T1	A11:A10,*A15--[1]
+ ||	MVC	.S2	CSR,B12
+
+	STDW	.D2T2	B9:B8,*SP--[1]
+ ||	STDW	.D1T1	A9:A8,*A15--[1]
+ ||	MVC	.S2	RILC,B11
+	STDW	.D2T2	B7:B6,*SP--[1]
+ ||	STDW	.D1T1	A7:A6,*A15--[1]
+ ||	MVC	.S2	ILC,B10
+	STDW	.D2T2	B5:B4,*SP--[1]
+ ||	STDW	.D1T1	A5:A4,*A15--[1]
+	STDW	.D2T2	B3:B2,*SP--[1]
+ ||	STDW	.D1T1	A3:A2,*A15--[1]
+ ||	MVC	.S2	__tsr,B5
+	STDW	.D2T2	B1:B0,*SP--[1]
+ ||	STDW	.D1T1	A1:A0,*A15--[1]
+ ||	MV	.S1X	B5,A5
+
+	STDW	.D2T2	B31:B30,*SP--[1]
+ ||	STDW	.D1T1	A31:A30,*A15--[1]
+ || MVKL	1,A4
+
+	STDW	.D2T2	B29:B28,*SP--[1]
+ ||	STDW	.D1T1	A29:A28,*A15--[1]
+	STDW	.D2T2	B27:B26,*SP--[1]
+ ||	STDW	.D1T1	A27:A26,*A15--[1]
+	STDW	.D2T2	B25:B24,*SP--[1]
+ ||	STDW	.D1T1	A25:A24,*A15--[1]
+	STDW	.D2T2	B23:B22,*SP--[1]
+ ||	STDW	.D1T1	A23:A22,*A15--[1]
+	STDW	.D2T2	B21:B20,*SP--[1]
+ ||	STDW	.D1T1	A21:A20,*A15--[1]
+	STDW	.D2T2	B19:B18,*SP--[1]
+ ||	STDW	.D1T1	A19:A18,*A15--[1]
+	STDW	.D2T2	B17:B16,*SP--[1]
+ ||	STDW	.D1T1	A17:A16,*A15--[1]
+
+	STDW	.D2T2	B13:B12,*SP--[1]    ; save PC and CSR
+	STDW	.D2T2	B11:B10,*SP--[1]    ; save RILC and ILC
+	STDW	.D2T1	A5:A4,*SP--[1]      ; save TSR and  orig A4(stack type)
+			.endm
+
+RESTORE_ALL	.macro  __rp, __tsr
+	LDDW	.D2T2	*++SP[1],B9:B8      ; get TSR (B9)
+	LDDW	.D2T2	*++SP[1],B11:B10    ; get RILC (B11) and ILC (B10)
+	LDDW	.D2T2	*++SP[1],B13:B12    ; get PC (B13) and CSR (B12)
+
+	ADDAW	.D1X	SP,30,A15
+
+	LDDW	.D1T1	*++A15[1],A17:A16
+ ||	LDDW	.D2T2	*++SP[1],B17:B16
+	LDDW	.D1T1	*++A15[1],A19:A18
+ ||	LDDW	.D2T2	*++SP[1],B19:B18
+	LDDW	.D1T1	*++A15[1],A21:A20
+ ||	LDDW	.D2T2	*++SP[1],B21:B20
+	LDDW	.D1T1	*++A15[1],A23:A22
+ ||	LDDW	.D2T2	*++SP[1],B23:B22
+	LDDW	.D1T1	*++A15[1],A25:A24
+ ||	LDDW	.D2T2	*++SP[1],B25:B24
+	LDDW	.D1T1	*++A15[1],A27:A26
+ ||	LDDW	.D2T2	*++SP[1],B27:B26
+	LDDW	.D1T1	*++A15[1],A29:A28
+ ||	LDDW	.D2T2	*++SP[1],B29:B28
+	LDDW	.D1T1	*++A15[1],A31:A30
+ ||	LDDW	.D2T2	*++SP[1],B31:B30
+
+	LDDW	.D1T1	*++A15[1],A1:A0
+ ||	LDDW	.D2T2	*++SP[1],B1:B0
+	LDDW	.D1T1	*++A15[1],A3:A2
+ ||	LDDW	.D2T2	*++SP[1],B3:B2
+ ||	MVC	.S2	B9,__tsr
+	LDDW	.D1T1	*++A15[1],A5:A4
+ ||	LDDW	.D2T2	*++SP[1],B5:B4
+ ||	MVC	.S2	B11,RILC
+	LDDW	.D1T1	*++A15[1],A7:A6
+ ||	LDDW	.D2T2	*++SP[1],B7:B6
+ ||	MVC	.S2	B10,ILC
+	LDDW	.D1T1	*++A15[1],A9:A8
+ ||	LDDW	.D2T2	*++SP[1],B9:B8
+ ||	MVC	.S2	B13,__rp
+
+	LDDW	.D1T1	*++A15[1],A11:A10
+ ||	LDDW	.D2T2	*++SP[1],B11:B10
+ ||	MVC	.S2	B12,CSR
+	LDDW	.D1T1	*++A15[1],A13:A12
+ ||	LDDW	.D2T2	*++SP[1],B13:B12
+
+	MV	.D2X	A15,SP
+ ||	MVKL	.S1	rt_system_stack_top,A15
+	MVKH	.S1	rt_system_stack_top,A15
+ ||	ADDAW	.D1X	SP,6,A14
+	STW	.D1T1	A14,*A15                ; save system stack pointer
+
+ 	LDDW	.D2T1	*++SP[1],A15:A14
+	LDDW	.D2T2	*+SP[1],SP:DP
+	NOP		4
+			.endm
+
+THREAD_SAVE_ALL	.macro  __rp, __tsr
+	STDW	.D2T2	SP:DP,*--SP[1]
+	SUBAW	.D2	SP,2,SP
+
+	ADD	.D1X	SP,-8,A15
+ ||	STDW	.D2T1	A15:A14,*SP--[16]   ; save A15:A14
+
+	STDW	.D2T2	B13:B12,*SP--[1]
+ ||	STDW	.D1T1	A13:A12,*A15--[1]
+ ||	MVC	.S2	__rp,B13
+	STDW	.D2T2	B11:B10,*SP--[1]
+ ||	STDW	.D1T1	A11:A10,*A15--[1]
+ ||	MVC	.S2	CSR,B12
+
+	STDW	.D2T2	B9:B8,*SP--[1]
+ ||	STDW	.D1T1	A9:A8,*A15--[1]
+ ||	MVC	.S2	RILC,B11
+	STDW	.D2T2	B7:B6,*SP--[1]
+ ||	STDW	.D1T1	A7:A6,*A15--[1]
+ ||	MVC	.S2	ILC,B10
+	STDW	.D2T2	B5:B4,*SP--[1]
+ ||	STDW	.D1T1	A5:A4,*A15--[1]
+	STDW	.D2T2	B3:B2,*SP--[1]
+ ||	STDW	.D1T1	A3:A2,*A15--[1]
+ ||	MVC	.S2	__tsr,B5
+	STDW	.D2T2	B1:B0,*SP--[1]
+ ||	STDW	.D1T1	A1:A0,*A15--[1]
+ ||	MV	.S1X	B5,A5
+
+	STDW	.D2T2	B31:B30,*SP--[1]
+ ||	STDW	.D1T1	A31:A30,*A15--[1]
+ || MVKL	1,A4
+	STDW	.D2T2	B29:B28,*SP--[1]
+ ||	STDW	.D1T1	A29:A28,*A15--[1]
+	STDW	.D2T2	B27:B26,*SP--[1]
+ ||	STDW	.D1T1	A27:A26,*A15--[1]
+	STDW	.D2T2	B25:B24,*SP--[1]
+ ||	STDW	.D1T1	A25:A24,*A15--[1]
+	STDW	.D2T2	B23:B22,*SP--[1]
+ ||	STDW	.D1T1	A23:A22,*A15--[1]
+	STDW	.D2T2	B21:B20,*SP--[1]
+ ||	STDW	.D1T1	A21:A20,*A15--[1]
+	STDW	.D2T2	B19:B18,*SP--[1]
+ ||	STDW	.D1T1	A19:A18,*A15--[1]
+	STDW	.D2T2	B17:B16,*SP--[1]
+ ||	STDW	.D1T1	A17:A16,*A15--[1]
+
+	STDW	.D2T2	B13:B12,*SP--[1]    ; save PC and CSR
+	STDW	.D2T2	B11:B10,*SP--[1]    ; save RILC and ILC
+	STDW	.D2T1	A5:A4,*SP--[1]      ; save TSR and orig A4(stack type)
+				.endm
diff --git a/libcpu/ti-dsp/c6x/cpuport.c b/libcpu/ti-dsp/c6x/cpuport.c
new file mode 100644
index 0000000000..3f755a5c7c
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/cpuport.c
@@ -0,0 +1,196 @@
+/*
+ * Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2021-11-16     Dystopia     the first version
+ */
+
+#include <rthw.h>
+#include <rtthread.h>
+
+#include "trap.h"
+
+/*------------ rt_hw_cpu_shutdown() function ----------------------------------
+ * DESCRIPTION: Shutdown CPU
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+RT_WEAK void rt_hw_cpu_shutdown(void)
+{
+    rt_kprintf("shutdown...\n");
+
+    rt_hw_interrupt_disable();
+
+    RT_ASSERT(0);
+}
+
+/*------------ nested_exception_handler() function ---------------------------
+ * DESCRIPTION: Function handles Nested Exception
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+
+void nested_exception_handler(void)
+{
+    for(;;){}
+}
+
+/*------------ hw_nmi_handler() function --------------------------------------
+ * DESCRIPTION: Function handles NMI interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_nmi_handler(struct rt_hw_exp_stack_register *regs)
+{
+    for(;;){}
+}
+
+/*------------ hw_bad_handler() function --------------------------------------
+ * DESCRIPTION: Function handles Bad interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_bad_handler(void)
+{
+    for(;;){}
+}
+
+/*------------ hw_int4_handler() function -------------------------------------
+ * DESCRIPTION: Function handles INT4 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int4_handler(void)
+{
+
+}
+
+/*------------ hw_int5_handler() function -------------------------------------
+ * DESCRIPTION: Function handles INT5 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int5_handler(void)
+{
+
+}
+
+/*------------ hw_int6_handler() function -------------------------------------
+ * DESCRIPTION: Function handles INT6 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int6_handler(void)
+{
+
+}
+
+/*------------ hw_int7_handler() function -------------------------------------
+ * DESCRIPTION: Function handles INT7 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int7_handler(void)
+{
+
+}
+
+/*------------ hw_int8_handler() function -------------------------------------
+ * DESCRIPTION: Function handles INT8 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int8_handler(void)
+{
+
+}
+
+/*------------ hw_int9_handler() function -------------------------------------
+ * DESCRIPTION: Function handles INT9 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int9_handler(void)
+{
+
+}
+
+/*------------ hw_int10_handler() function ------------------------------------
+ * DESCRIPTION: Function handles INT10 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int10_handler(void)
+{
+
+}
+
+/*------------ hw_int11_handler() function ------------------------------------
+ * DESCRIPTION: Function handles INT11 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int11_handler(void)
+{
+
+}
+
+/*------------ hw_int12_handler() function ------------------------------------
+ * DESCRIPTION: Function handles INT12 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int12_handler(void)
+{
+    
+}
+
+/*------------ hw_int13_handler() function ------------------------------------
+ * DESCRIPTION: Function handles INT13 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int13_handler(void)
+{
+
+}
+
+/*------------------ hw_int14_handler() function ------------------------------
+ * DESCRIPTION: Function handles INT14 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE:
+-----------------------------------------------------------------------------*/
+void hw_int14_handler(void)
+{
+extern void rt_hw_systick_isr();
+    rt_hw_systick_isr();
+}
+
+/*------------ hw_int15_handler() function ------------------------------------
+ * DESCRIPTION: Function handles INT15 interrupt
+ * ARGUMENTS:
+ * None
+ * RETURNED VALUE: None
+-----------------------------------------------------------------------------*/
+void hw_int15_handler(void)
+{
+
+}
diff --git a/libcpu/ti-dsp/c6x/interrupt.c b/libcpu/ti-dsp/c6x/interrupt.c
new file mode 100644
index 0000000000..6e48cb8efa
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/interrupt.c
@@ -0,0 +1,104 @@
+/*
+ * Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2021-11-16     Dystopia     the first version
+ */
+
+#include "interrupt.h"
+#include "c66xx.h"
+#include "trap.h"
+
+#define MAX_HANDLERS 128
+
+extern volatile rt_uint8_t rt_interrupt_nest;
+struct rt_irq_desc isr_table[MAX_HANDLERS];
+rt_uint32_t rt_interrupt_from_thread;
+rt_uint32_t rt_interrupt_to_thread;
+rt_uint32_t rt_thread_switch_interrupt_flag;
+
+/**
+ * This function will initialize hardware interrupt
+ */
+void rt_hw_interrupt_init(void)
+{
+    // initial system trap
+    //rt_trap_init();
+
+    /* init exceptions table */
+    rt_memset(isr_table, 0x00, sizeof(isr_table));
+
+    /* init interrupt nest, and context in thread sp */
+    rt_interrupt_nest = 0;
+    rt_interrupt_from_thread = 0;
+    rt_interrupt_to_thread = 0;
+    rt_thread_switch_interrupt_flag = 0;
+}
+
+/**
+ * This function will mask a interrupt.
+ * @param vector the interrupt number
+ */
+void rt_hw_interrupt_mask(int vector)
+{
+    if (vector < 0 || vector >= MAX_HANDLERS)
+    {
+        return;
+    }
+}
+
+/**
+ * This function will un-mask a interrupt.
+ * @param vector the interrupt number
+ */
+void rt_hw_interrupt_umask(int vector)
+{
+    if (vector < 0 || vector >= MAX_HANDLERS)
+    {
+        return;
+    }
+    ICR = vector;
+    IER |= vector;
+
+    //enable GIE
+    TSR = TSR | 1;
+}
+
+/**
+ * This function will install a interrupt service routine to a interrupt.
+ * @param vector the interrupt number
+ * @param new_handler the interrupt service routine to be installed
+ * @param old_handler the old interrupt service routine
+ */
+rt_isr_handler_t rt_hw_interrupt_install(int vector, rt_isr_handler_t handler,
+        void *param, const char *name)
+{
+    rt_isr_handler_t old_handler = RT_NULL;
+
+    if (vector < MAX_HANDLERS || vector >= 0)
+    {
+        old_handler = isr_table[vector].handler;
+
+        if (handler != RT_NULL)
+        {
+#ifdef RT_USING_INTERRUPT_INFO
+            rt_strncpy(isr_table[vector].name, name, RT_NAME_MAX);
+#endif /* RT_USING_INTERRUPT_INFO */
+            isr_table[vector].handler = handler;
+            isr_table[vector].param = param;
+        }
+    }
+
+    return old_handler;
+}
+
+void rt_hw_interrupt_clear(int vector)
+{
+    if (vector < 0 || vector >= MAX_HANDLERS)
+    {
+        return;
+    }
+}
diff --git a/libcpu/ti-dsp/c6x/interrupt.h b/libcpu/ti-dsp/c6x/interrupt.h
new file mode 100644
index 0000000000..de7935b38a
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/interrupt.h
@@ -0,0 +1,24 @@
+/*
+ * Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2021-11-16     Dystopia     the first version
+ */
+
+#ifndef __INTERRUPT_H__
+#define __INTERRUPT_H__
+
+#include <rthw.h>
+#include <rtthread.h>
+
+void rt_hw_interrupt_init(void);
+void rt_hw_interrupt_mask(int vector);
+void rt_hw_interrupt_umask(int vector);
+void rt_hw_interrupt_clear(int vector);
+rt_isr_handler_t rt_hw_interrupt_install(int vector, rt_isr_handler_t handler,
+        void *param, const char *name);
+
+#endif /* __INTERRUPT_H__ */
diff --git a/libcpu/ti-dsp/c6x/intexc.asm b/libcpu/ti-dsp/c6x/intexc.asm
new file mode 100644
index 0000000000..81a77426ec
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/intexc.asm
@@ -0,0 +1,263 @@
+;
+; Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+;
+; SPDX-License-Identifier: Apache-2.0
+;
+; Change Logs:
+; Date           Author       Notes
+; 2021-11-16     Dystopia     the first version
+;
+
+;-----------------------------------------------------------
+;      interrupt and execption handler for C6000 DSP
+;-----------------------------------------------------------
+
+;-----------------------------------------------------------
+;                    macro definition
+;-----------------------------------------------------------
+DP	.set	B14
+SP	.set	B15
+;
+;-----------------------------------------------------------
+;
+	.include "contextinc.asm"
+;-----------------------------------------------------------
+;                     global function
+;-----------------------------------------------------------
+    .global _nmi_handler
+    .global _bad_handler
+    .global _int4_handler
+    .global _int5_handler
+    .global _int6_handler
+    .global _int7_handler
+    .global _int8_handler
+    .global _int9_handler
+    .global _int10_handler
+    .global _int11_handler
+    .global _int12_handler
+    .global _int13_handler
+    .global _int14_handler
+    .global _int15_handler
+;
+;-----------------------------------------------------------
+;
+
+;-----------------------------------------------------------
+;                     extern function
+;-----------------------------------------------------------
+	.ref hw_nmi_handler
+	.ref hw_bad_handler
+	.ref hw_int4_handler
+	.ref hw_int5_handler
+	.ref hw_int6_handler
+	.ref hw_int7_handler
+	.ref hw_int8_handler
+	.ref hw_int9_handler
+	.ref hw_int10_handler
+	.ref hw_int11_handler
+	.ref hw_int12_handler
+	.ref hw_int13_handler
+	.ref hw_int14_handler
+	.ref hw_int15_handler
+	.ref rt_hw_process_exception
+	.ref rt_interrupt_context_restore
+;
+;-----------------------------------------------------------
+;
+
+;-----------------------------------------------------------
+;               interrupt macro definition
+;-----------------------------------------------------------
+RT_INTERRUPT_ENTRY	.macro
+	SAVE_ALL	IRP,ITSR
+					.endm
+
+RT_CALL_INT .macro __isr
+    B	__isr
+    ADDKPC	$1	,B3,4
+$1:
+	B	.S1	rt_interrupt_context_restore
+	NOP	5
+			.endm
+;-----------------------------------------------------------
+;               execption macro definition
+;-----------------------------------------------------------
+RT_EXECPTION_ENTRY	.macro
+	SAVE_ALL NRP,NTSR
+					.endm
+
+RT_EXECPTION_EXIT	.macro
+	RESTORE_ALL NRP,NTSR
+	B	.S2	NRP   ; return from execption
+	NOP	5
+					.endm
+
+;
+;-----------------------------------------------------------
+;
+
+    .sect   ".text"
+;
+;-----------------------------------------------------------
+;
+
+;-----------------------------------------------------------
+; handler NMI interrupt
+;-----------------------------------------------------------
+_nmi_handler:
+;{
+	RT_EXECPTION_ENTRY
+	MVC	.S2	EFR,B2
+	CMPEQ	.L2	1,B2,B2
+ ||	MVC	.S2	TSR,B1
+	MV	.D1X	B2,A2
+ ||	CLR	.S2	B1,10,10,B1
+	MVC	.S2	B1,TSR
+ [!A2]	MVKL	.S1	rt_hw_process_exception,A0
+ ||[B2]	MVKL	.S2	rt_hw_software_exception,B1
+ [!A2]	MVKH	.S1	rt_hw_process_exception,A0
+ ||[B2]	MVKH	.S2	rt_hw_software_exception,B1
+ [!B2]	B	.S2X	A0
+ [B2]	B	.S2	B1
+ [!B2]	ADDAW	.D2	SP,2,B1
+ [!B2]	MV	.D1X	B1,A4
+	ADDKPC	.S2	ret_from_trap,B3,2
+;
+; return from trap
+;
+ret_from_trap:
+	MV	.D2X	A4,B0
+ [!B0]	MVKL	.S2	ret_from_exception,B3
+ [!B0]	MVKH	.S2	ret_from_exception,B3
+ [!B0]	BNOP	.S2	B3,5
+;
+; return from trap restore exception context
+;
+ret_from_exception:
+	RT_EXECPTION_EXIT
+;
+rt_hw_software_exception:
+	MVKL	.S1	rt_hw_process_exception,A0
+	MVKH	.S1	rt_hw_process_exception,A0
+	B	.S2X	A0
+	ADDAW	.D2	SP,2,B1
+	MV	.D1X	B1,A4
+	ADDKPC	.S2	ret_from_trap,B3,2
+	NOP	2
+;}
+
+;-----------------------------------------------------------
+; handler bad interrupt
+;-----------------------------------------------------------
+_bad_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_bad_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT4 interrupt
+;-----------------------------------------------------------
+_int4_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int4_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT5 interrupt
+;-----------------------------------------------------------
+_int5_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int5_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT6 interrupt
+;-----------------------------------------------------------
+_int6_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int6_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT7 interrupt
+;-----------------------------------------------------------
+_int7_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int7_handler
+;}
+;-----------------------------------------------------------
+; handler INT8 interrupt
+;-----------------------------------------------------------
+_int8_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int8_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT9 interrupt
+;-----------------------------------------------------------
+_int9_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int9_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT10 interrupt
+;-----------------------------------------------------------
+_int10_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int10_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT11 interrupt
+;-----------------------------------------------------------
+_int11_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int11_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT12 interrupt
+;-----------------------------------------------------------
+_int12_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int12_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT13 interrupt
+;-----------------------------------------------------------
+_int13_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int13_handler
+;}
+
+;-----------------------------------------------------------
+; handler INT14 interrupt
+;-----------------------------------------------------------
+_int14_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int14_handler
+;}
+;-----------------------------------------------------------
+; handler INT15 interrupt
+;-----------------------------------------------------------
+_int15_handler:
+;{
+	RT_INTERRUPT_ENTRY
+	RT_CALL_INT	hw_int15_handler
+;}
+	.end
diff --git a/libcpu/ti-dsp/c6x/stack.c b/libcpu/ti-dsp/c6x/stack.c
new file mode 100644
index 0000000000..05e9534538
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/stack.c
@@ -0,0 +1,120 @@
+/*
+ * Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2021-11-16     Dystopia     the first version
+ */
+
+#include <rtthread.h>
+#include <c66xx.h>
+
+extern rt_uint32_t rt_hw_get_current_dp(void);
+
+/**
+ * @addtogroup C66xx
+ */
+/*@{*/
+
+/**
+ * This function will initialize thread stack
+ *
+ * @param tentry the entry of thread
+ * @param parameter the parameter of entry
+ * @param stack_addr the beginning stack address
+ * @param texit the function will be called when thread exit
+ *
+ * @return stack address
+ */
+rt_uint8_t *rt_hw_stack_init(void *tentry, void *parameter,
+                             rt_uint8_t *stack_addr, void *texit)
+{
+    rt_hw_thread_stack_register *thread_context = RT_NULL;
+    rt_uint32_t stk = 0;
+
+    stack_addr += sizeof(rt_uint32_t);
+    stack_addr  = (rt_uint8_t *)RT_ALIGN_DOWN((rt_uint32_t)stack_addr, 8);
+    stk         = (rt_uint32_t)stack_addr;
+    thread_context = (rt_hw_thread_stack_register *)(stk - sizeof(rt_hw_thread_stack_register));
+
+    thread_context->pc = (rt_uint32_t)tentry;
+    thread_context->csr = 0x0103;
+    thread_context->tsr = 0x3;
+    thread_context->orig_a4 = 1;
+    thread_context->ilc = 0;
+    thread_context->rilc = 0;
+
+    thread_context->hw_register.b17 = 0xB17;
+    thread_context->hw_register.b16  = 0xB16;
+    thread_context->hw_register.b19  = 0xB19;
+    thread_context->hw_register.b18  = 0xB18;
+    thread_context->hw_register.b21  = 0xB21;
+    thread_context->hw_register.b20  = 0xB20;
+    thread_context->hw_register.b23  = 0xB23;
+    thread_context->hw_register.b22  = 0xB22;
+    thread_context->hw_register.b25  = 0xB25;
+    thread_context->hw_register.b24  = 0xB24;
+    thread_context->hw_register.b27  = 0xB27;
+    thread_context->hw_register.b26  = 0xB26;
+    thread_context->hw_register.b29  = 0xB29;
+    thread_context->hw_register.b28  = 0xB28;
+    thread_context->hw_register.b31  = 0xB31;
+    thread_context->hw_register.b30  = 0xB30;
+
+    thread_context->hw_register.b1  = 0xB01;
+    thread_context->hw_register.b0  = 0xB00;
+    thread_context->hw_register.b3  = (rt_uint32_t)texit;
+    thread_context->hw_register.b2  = 0xB02;
+    thread_context->hw_register.b5  = 0xB05;
+    thread_context->hw_register.b4  = 0xB04;
+    thread_context->hw_register.b7  = 0xB07;
+    thread_context->hw_register.b6  = 0xB06;
+    thread_context->hw_register.b9  = 0xB09;
+    thread_context->hw_register.b8  = 0xB08;
+    thread_context->hw_register.b11  = 0xB11;
+    thread_context->hw_register.b10  = 0xB10;
+    thread_context->hw_register.b13  = 0xB13;
+    thread_context->hw_register.b12  = 0xB12;
+
+    thread_context->hw_register.a17  = 0xA17;
+    thread_context->hw_register.a16  = 0xA16;
+    thread_context->hw_register.a19  = 0xA19;
+    thread_context->hw_register.a18  = 0xA18;
+    thread_context->hw_register.a21  = 0xA21;
+    thread_context->hw_register.a20  = 0xA20;
+    thread_context->hw_register.a23  = 0xA23;
+    thread_context->hw_register.a22  = 0xA22;
+    thread_context->hw_register.a25  = 0xA25;
+    thread_context->hw_register.a24  = 0xA24;
+    thread_context->hw_register.a27  = 0xA27;
+    thread_context->hw_register.a26  = 0xA26;
+    thread_context->hw_register.a29  = 0xA29;
+    thread_context->hw_register.a28  = 0xA28;
+    thread_context->hw_register.a31  = 0xA31;
+    thread_context->hw_register.a30  = 0xA30;
+
+    thread_context->hw_register.a1  = 0xA01;
+    thread_context->hw_register.a0  = 0xA00;
+    thread_context->hw_register.a3  = 0xA03;
+    thread_context->hw_register.a2  = 0xA02;
+    thread_context->hw_register.a5  = 0xA05;
+    thread_context->hw_register.a4  = (rt_uint32_t)parameter;
+    thread_context->hw_register.a7  = 0xA07;
+    thread_context->hw_register.a6  = 0xA06;
+    thread_context->hw_register.a9  = 0xA09;
+    thread_context->hw_register.a8  = 0xA08;
+    thread_context->hw_register.a11  = 0xA11;
+    thread_context->hw_register.a10  = 0xA10;
+    thread_context->hw_register.a13  = 0xA13;
+    thread_context->hw_register.a12  = 0xA12;
+
+    thread_context->hw_register.a15  = 0xA15;
+    thread_context->hw_register.a14  = 0xA14;
+    thread_context->hw_register.dp  = rt_hw_get_current_dp();
+    thread_context->hw_register.sp  = (rt_uint32_t)stk;
+
+    /* return task's current stack address */
+    return (rt_uint8_t *)thread_context - 8;
+}
diff --git a/libcpu/ti-dsp/c6x/trap.c b/libcpu/ti-dsp/c6x/trap.c
new file mode 100644
index 0000000000..9f8f80d5ed
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/trap.c
@@ -0,0 +1,367 @@
+/*
+ * Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2021-11-16     Dystopia     the first version
+ */
+
+#include "trap.h"
+#include "c66xx.h"
+
+#include <rthw.h>
+#include <rtdef.h>
+#include <rtthread.h>
+
+#define RT_SYS_STACK_SIZE    4096
+
+rt_uint8_t rt_system_stack[RT_SYS_STACK_SIZE];
+rt_uint8_t *rt_system_stack_top;
+
+void rt_trap_init(void)
+{
+    rt_system_stack_top = &rt_system_stack[RT_SYS_STACK_SIZE-1];
+    rt_system_stack_top  = (rt_uint8_t *)RT_ALIGN_DOWN((rt_uint32_t)rt_system_stack_top, 8);
+
+    ack_exception(EXCEPT_TYPE_NXF);
+    ack_exception(EXCEPT_TYPE_EXC);
+    ack_exception(EXCEPT_TYPE_IXF);
+    ack_exception(EXCEPT_TYPE_SXF);
+    rt_hw_enable_exception();
+}
+
+void show_regs(struct rt_hw_exp_stack_register *regs)
+{
+    rt_kprintf("\n");
+    rt_kprintf("PC: %08lx SP: %08lx\n",
+           regs->pc, regs->hw_register.sp);
+    rt_kprintf("Status: %08lx ORIG_A4: %08lx\n",
+           regs->csr, regs->orig_a4);
+    rt_kprintf("A0: %08lx  B0: %08lx\n",
+           regs->hw_register.a0, regs->hw_register.b0);
+    rt_kprintf("A1: %08lx  B1: %08lx\n",
+           regs->hw_register.a1, regs->hw_register.b1);
+    rt_kprintf("A2: %08lx  B2: %08lx\n",
+           regs->hw_register.a2, regs->hw_register.b2);
+    rt_kprintf("A3: %08lx  B3: %08lx\n",
+           regs->hw_register.a3, regs->hw_register.b3);
+    rt_kprintf("A4: %08lx  B4: %08lx\n",
+           regs->hw_register.a4, regs->hw_register.b4);
+    rt_kprintf("A5: %08lx  B5: %08lx\n",
+           regs->hw_register.a5, regs->hw_register.b5);
+    rt_kprintf("A6: %08lx  B6: %08lx\n",
+           regs->hw_register.a6, regs->hw_register.b6);
+    rt_kprintf("A7: %08lx  B7: %08lx\n",
+           regs->hw_register.a7, regs->hw_register.b7);
+    rt_kprintf("A8: %08lx  B8: %08lx\n",
+           regs->hw_register.a8, regs->hw_register.b8);
+    rt_kprintf("A9: %08lx  B9: %08lx\n",
+           regs->hw_register.a9, regs->hw_register.b9);
+    rt_kprintf("A10: %08lx  B10: %08lx\n",
+           regs->hw_register.a10, regs->hw_register.b10);
+    rt_kprintf("A11: %08lx  B11: %08lx\n",
+           regs->hw_register.a11, regs->hw_register.b11);
+    rt_kprintf("A12: %08lx  B12: %08lx\n",
+           regs->hw_register.a12, regs->hw_register.b12);
+    rt_kprintf("A13: %08lx  B13: %08lx\n",
+           regs->hw_register.a13, regs->hw_register.b13);
+    rt_kprintf("A14: %08lx  B14: %08lx\n",
+           regs->hw_register.a14, regs->hw_register.dp);
+    rt_kprintf("A15: %08lx  B15: %08lx\n",
+           regs->hw_register.a15, regs->hw_register.sp);
+    rt_kprintf("A16: %08lx  B16: %08lx\n",
+           regs->hw_register.a16, regs->hw_register.b16);
+    rt_kprintf("A17: %08lx  B17: %08lx\n",
+           regs->hw_register.a17, regs->hw_register.b17);
+    rt_kprintf("A18: %08lx  B18: %08lx\n",
+           regs->hw_register.a18, regs->hw_register.b18);
+    rt_kprintf("A19: %08lx  B19: %08lx\n",
+           regs->hw_register.a19, regs->hw_register.b19);
+    rt_kprintf("A20: %08lx  B20: %08lx\n",
+           regs->hw_register.a20, regs->hw_register.b20);
+    rt_kprintf("A21: %08lx  B21: %08lx\n",
+           regs->hw_register.a21, regs->hw_register.b21);
+    rt_kprintf("A22: %08lx  B22: %08lx\n",
+           regs->hw_register.a22, regs->hw_register.b22);
+    rt_kprintf("A23: %08lx  B23: %08lx\n",
+           regs->hw_register.a23, regs->hw_register.b23);
+    rt_kprintf("A24: %08lx  B24: %08lx\n",
+           regs->hw_register.a24, regs->hw_register.b24);
+    rt_kprintf("A25: %08lx  B25: %08lx\n",
+           regs->hw_register.a25, regs->hw_register.b25);
+    rt_kprintf("A26: %08lx  B26: %08lx\n",
+           regs->hw_register.a26, regs->hw_register.b26);
+    rt_kprintf("A27: %08lx  B27: %08lx\n",
+           regs->hw_register.a27, regs->hw_register.b27);
+    rt_kprintf("A28: %08lx  B28: %08lx\n",
+           regs->hw_register.a28, regs->hw_register.b28);
+    rt_kprintf("A29: %08lx  B29: %08lx\n",
+           regs->hw_register.a29, regs->hw_register.b29);
+    rt_kprintf("A30: %08lx  B30: %08lx\n",
+           regs->hw_register.a30, regs->hw_register.b30);
+    rt_kprintf("A31: %08lx  B31: %08lx\n",
+           regs->hw_register.a31, regs->hw_register.b31);
+}
+
+void do_trap(struct rt_exception_info *except_info, struct rt_hw_exp_stack_register *regs)
+{
+    rt_kprintf("Enter exception: %s\n", except_info->kernel_str);
+
+    show_regs(regs);
+
+    for(;;){}
+}
+
+static struct rt_exception_info iexcept_table[10] = {
+    { " - instruction fetch",         ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - fetch packet",              ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - execute packet",            ABORT_TYPE_UNDDEF, ABORT_OPCODE_ILL },
+    { " - undefined instruction",     ABORT_TYPE_UNDDEF, ABORT_OPCODE_ILL },
+    { " - resource conflict",         ABORT_TYPE_UNDDEF, ABORT_OPCODE_ILL },
+    { " - resource access",           ABORT_TYPE_UNDDEF, ABORT_PRVREG_ILL },
+    { " - privilege",                 ABORT_TYPE_UNDDEF, ABORT_PRVOPC_ILL },
+    { " - loops buffer",              ABORT_TYPE_UNDDEF, ABORT_PRVOPC_ILL },
+    { " - software exception",        ABORT_TYPE_UNDDEF, ABORT_ILLTRP_ILL },
+    { " - unknown exception",         ABORT_TYPE_UNDDEF, ABORT_PRVOPC_ILL }
+};
+
+/*
+ * Process an internal exception (non maskable)
+ */
+static int process_iexcept(struct rt_hw_exp_stack_register *regs)
+{
+    unsigned int iexcept_report = get_iexcept();
+    unsigned int iexcept_num = 0;
+
+    ack_exception(EXCEPT_TYPE_IXF);
+
+    while(iexcept_report)
+    {
+        iexcept_num = ffs(iexcept_report);
+        iexcept_report &= ~(1 << iexcept_num);
+        set_iexcept(iexcept_report);
+
+        if (*(unsigned int *)regs->pc == BKPT_OPCODE)
+        {
+            /* This is a breakpoint */
+            struct rt_exception_info bkpt_exception = \
+                                     { " - undefined instruction",\
+                                     ABORT_TYPE_UNDDEF, ABORT_BRKPT_ILL };
+            do_trap(&bkpt_exception, regs);
+            iexcept_report &= ~(0xFF);
+            set_iexcept(iexcept_report);
+            continue;
+        }
+        do_trap(&iexcept_table[iexcept_num], regs);
+    }
+    return 0;
+}
+
+static struct rt_exception_info eexcept_table[128] = {
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+    { " - external exception", ABORT_TYPE_BUS, ABORT_BUS_ADDRERR },
+
+    { " - CPU memory protection fault",        ABORT_TYPE_MAP, ABORT_BUS_ACCERR },
+    { " - CPU memory protection fault in L1P", ABORT_TYPE_MAP, ABORT_BUS_ACCERR },
+    { " - DMA memory protection fault in L1P", ABORT_TYPE_MAP, ABORT_BUS_ACCERR },
+    { " - CPU memory protection fault in L1D", ABORT_TYPE_MAP, ABORT_BUS_ACCERR },
+    { " - DMA memory protection fault in L1D", ABORT_TYPE_MAP, ABORT_BUS_ACCERR },
+    { " - CPU memory protection fault in L2",  ABORT_TYPE_MAP, ABORT_BUS_ACCERR },
+    { " - DMA memory protection fault in L2",  ABORT_TYPE_MAP, ABORT_BUS_ACCERR },
+    { " - EMC CPU memory protection fault",    ABORT_TYPE_MAP, ABORT_BUS_ACCERR },
+    { " - EMC bus error",                      ABORT_TYPE_MAP, ABORT_BUS_ADDRERR }
+};
+
+/*
+ * Process an external exception (maskable)
+ */
+static void process_eexcept(struct rt_hw_exp_stack_register *regs)
+{
+    int except_num = 0;
+    int bank = 0;
+    int i = 0;
+
+    for (i = 0; i <= 3; i++)
+    {
+        while (INTC_MEXPMASK[i]) 
+       {
+            __dint();
+            except_num = ffs(INTC_MEXPMASK[i]);
+            INTC_MEXPMASK[i] &= ~(1 << except_num); /* ack the external exception */
+            __rint();
+            do_trap(&eexcept_table[except_num + (bank << 5)], regs);
+        }
+        bank++;
+    }
+
+    ack_exception(EXCEPT_TYPE_EXC);
+}
+
+extern void hw_nmi_handler(struct rt_hw_exp_stack_register *regs);
+/*
+ * Main exception processing
+ */
+int rt_hw_process_exception(struct rt_hw_exp_stack_register *regs)
+{
+    int type = 0;
+    int type_num = 0;
+    int ie_num = 9; /* default is unknown exception */
+
+    while ((type = get_except_type()) != 0) {
+        type_num = fls(type) - 1;
+
+        switch(type_num) {
+        case EXCEPT_TYPE_NXF:                   /* NMI exception   */
+            ack_exception(EXCEPT_TYPE_NXF);     /* clear exception */
+            if (hw_nmi_handler != RT_NULL)
+            {
+                hw_nmi_handler(regs);
+            }
+            break;
+
+        case EXCEPT_TYPE_IXF:                   /* internal exception */
+            if (process_iexcept(regs))
+            {
+                return 1;
+            }
+            break;
+
+        case EXCEPT_TYPE_EXC:                   /* external exception  */
+            process_eexcept(regs);
+            break;
+
+        case EXCEPT_TYPE_SXF:                   /* software exception */
+            ie_num = 8;
+            ack_exception(type_num);
+            break;
+        default:                                /* clear exception */
+            ack_exception(type_num);
+            do_trap(&iexcept_table[ie_num], regs);
+            break;
+        }
+    }
+    return 0;
+}
+
diff --git a/libcpu/ti-dsp/c6x/trap.h b/libcpu/ti-dsp/c6x/trap.h
new file mode 100644
index 0000000000..d895344728
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/trap.h
@@ -0,0 +1,117 @@
+/*
+ * Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+ *
+ * SPDX-License-Identifier: Apache-2.0
+ *
+ * Change Logs:
+ * Date           Author       Notes
+ * 2021-11-16     Dystopia     the first version
+ */
+
+#ifndef __TRAP_H__
+#define __TRAP_H__
+
+#include "c66xx.h"
+
+/*
+ * exception operation macro
+ */
+#define disable_exception()
+#define get_except_type()       EFR
+#define ack_exception(type)     ECR = 1ul << (type)
+#define get_iexcept()           IERR
+#define set_iexcept(mask)       IERR = (mask)
+
+/*
+ * exception types
+ */
+#define EXCEPT_TYPE_NXF   31       /* NMI */
+#define EXCEPT_TYPE_EXC   30       /* external exception */
+#define EXCEPT_TYPE_IXF   1        /* internal exception */
+#define EXCEPT_TYPE_SXF   0        /* software exception */
+
+#define EXCEPT_CAUSE_LBX  (1 << 7) /* loop buffer exception */
+#define EXCEPT_CAUSE_PRX  (1 << 6) /* privilege exception */
+#define EXCEPT_CAUSE_RAX  (1 << 5) /* resource access exception */
+#define EXCEPT_CAUSE_RCX  (1 << 4) /* resource conflict exception */
+#define EXCEPT_CAUSE_OPX  (1 << 3) /* opcode exception */
+#define EXCEPT_CAUSE_EPX  (1 << 2) /* execute packet exception */
+#define EXCEPT_CAUSE_FPX  (1 << 1) /* fetch packet exception */
+#define EXCEPT_CAUSE_IFX  (1 << 0) /* instruction fetch exception */
+
+enum SYSTEM_TRAP_CODE
+{
+    ABORT_BUS_ADDRERR = 0,  // bus address error
+    ABORT_BUS_ACCERR,       // bus access permission error
+    ABORT_OPCODE_ILL,       // illegal opcode
+    ABORT_PRVREG_ILL,       // privilege register
+    ABORT_PRVOPC_ILL,       // privileged opcode
+    ABORT_ILLTRP_ILL,       // illegal trap
+    ABORT_BRKPT_ILL,        // handling breakpoints
+};
+
+/*
+ * abort types
+ */
+#define ABORT_TYPE_BUS        0           // bus access abnormal
+#define ABORT_TYPE_MAP        1           // page table mapping error
+#define ABORT_TYPE_UNDDEF     0xff        // undefined exception
+#define ABORT_TYPE_FATAL      0xffffffff  // fatal error
+
+struct rt_exception_info {
+    char *kernel_str;
+    int type;
+    int code;
+};
+
+#define BKPT_OPCODE        0x56454314    /* illegal opcode */
+#define INTC_MEXPMASK    __SYSREGA(0x018000e0, unsigned int)
+
+extern void rt_trap_init(void);
+extern void rt_hw_enable_exception(void);
+extern int __fls(int val);
+extern int __ffs(int val);
+
+/*
+ * ffz - find first zero in word.
+ * @word: The word to search
+ *
+ * Undefined if no zero exists, so code should check against ~0UL first.
+ */
+#define ffz(x) __ffs(~(x))
+
+/**
+ * fls - find last (most-significant) bit set
+ * @x: the word to search
+ *
+ * This is defined the same way as ffs.
+ * Note fls(0) = 0, fls(1) = 1, fls(0x80000000) = 32.
+ */
+static inline int fls(int x)
+{
+    if (!x)
+    {
+        return 0;
+    }
+    return 32 - __fls(x);
+}
+
+/**
+ * ffs - find first bit set
+ * @x: the word to search
+ *
+ * This is defined the same way as
+ * the libc and compiler builtin ffs routines, therefore
+ * differs in spirit from the above ffz (man ffs).
+ * Note ffs(0) = 0, ffs(1) = 1, ffs(0x80000000) = 32.
+ */
+static inline int ffs(int x)
+{
+    if (!x)
+    {
+        return 0;
+    }
+    return __ffs(x) + 1;
+}
+
+#endif /* __TRAP_H__ */
diff --git a/libcpu/ti-dsp/c6x/vector.asm b/libcpu/ti-dsp/c6x/vector.asm
new file mode 100644
index 0000000000..3c8123abd7
--- /dev/null
+++ b/libcpu/ti-dsp/c6x/vector.asm
@@ -0,0 +1,95 @@
+;
+; Copyright (c) 2021, Shenzhen Academy of Aerospace Technology
+;
+; SPDX-License-Identifier: Apache-2.0
+;
+; Change Logs:
+; Date           Author       Notes
+; 2021-11-16     Dystopia     the first version
+;
+
+;-----------------------------------------------------------
+; 			interrupt vector table for C6000 DSP
+;-----------------------------------------------------------
+
+;-----------------------------------------------------------
+; 						extern function
+;-----------------------------------------------------------
+	.ref _c_int00		; entry point
+    .ref _nmi_handler
+    .ref _bad_handler
+    .ref _int4_handler
+    .ref _int5_handler
+    .ref _int6_handler
+    .ref _int7_handler
+    .ref _int8_handler
+    .ref _int9_handler
+    .ref _int10_handler
+    .ref _int11_handler
+    .ref _int12_handler
+    .ref _int13_handler
+    .ref _int14_handler
+    .ref _int15_handler
+
+;-----------------------------------------------------------
+; 						macro definition
+;-----------------------------------------------------------
+
+;
+; create interrupt vector for reset (interrupt 0)
+;
+VEC_RESET .macro addr
+	MVKL  addr,B0
+	MVKH  addr,B0
+	B     B0
+	MVC   PCE1,B0
+	NOP   4
+	.align 32
+	.endm
+
+;
+; create interrupt vector for other used interrupts
+;
+IRQVEC	.macro  __name, __isr
+	.align 32
+	.hidden __name
+	.global __name
+__name:
+	B	.S2	__isr
+	NOP
+	NOP
+	NOP
+	NOP
+	NOP
+	NOP
+	NOP
+		.endm
+;
+;-----------------------------------------------------------
+;
+
+;
+; vector table
+;
+	.sect ".vecs"
+	.align 32
+	.global vector
+vector:
+	VEC_RESET		_c_int00
+	IRQVEC NMI,		_nmi_handler
+	IRQVEC AINT,	_bad_handler
+	IRQVEC MSGINT,	_bad_handler
+	IRQVEC INT4,	_int4_handler
+	IRQVEC INT5,	_int5_handler
+	IRQVEC INT6,	_int6_handler
+	IRQVEC INT7,	_int7_handler
+	IRQVEC INT8,	_int8_handler
+	IRQVEC INT9,	_int9_handler
+	IRQVEC INT10,	_int10_handler
+	IRQVEC INT11,	_int11_handler
+	IRQVEC INT12,	_int12_handler
+	IRQVEC INT13,	_int13_handler
+	IRQVEC INT14,	_int14_handler
+	IRQVEC INT15,	_int15_handler
+
+	.end