1 files changed, 111 insertions, 0 deletions
diff --git a/firmware/asm/mips/thread-mips32.c b/firmware/asm/mips/thread-mips32.c
new file mode 100644
index 0000000000..e754df7e29
--- /dev/null
+++ b/firmware/asm/mips/thread-mips32.c
@@ -0,0 +1,111 @@
+/***************************************************************************
+ *             __________               __   ___.
+ *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
+ *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
+ *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
+ *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
+ *                     \/            \/     \/    \/            \/
+ * $Id$
+ *
+ * Copyright (C) 2008 by Maurus Cuelenaere
+ *
+ * 32-bit MIPS threading support
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
+ * KIND, either express or implied.
+ *
+ ****************************************************************************/
+/*---------------------------------------------------------------------------
+ * Start the thread running and terminate it if it returns
+ *---------------------------------------------------------------------------
+ */
+void start_thread(void); /* Provide C access to ASM label */
+static void USED_ATTR _start_thread(void)
+{
+    /* t1 = context */
+    asm volatile (
+      "start_thread:          \n"
+        ".set noreorder       \n"
+        ".set noat            \n"
+        "lw     $8,    4($9)  \n" /* Fetch thread function pointer ($8 = t0, $9 = t1) */
+        "lw     $29,  36($9)  \n" /* Set initial sp(=$29) */
+        "jalr   $8            \n" /* Start the thread */
+        "sw     $0,   44($9)  \n" /* Clear start address */
+        ".set at              \n"
+        ".set reorder         \n"
+    );
+    thread_exit();
+}
+/* Place context pointer in s0 slot, function pointer in s1 slot, and
+ * start_thread pointer in context_start */
+#define THREAD_STARTUP_INIT(core, thread, function)            \
+    ({ (thread)->context.r[0]  = (uint32_t)&(thread)->context, \
+       (thread)->context.r[1]  = (uint32_t)(function),         \
+       (thread)->context.start = (uint32_t)start_thread; })
+/*---------------------------------------------------------------------------
+ * Store non-volatile context.
+ *---------------------------------------------------------------------------
+ */
+static inline void store_context(void* addr)
+{
+    asm volatile (
+        ".set noreorder        \n"
+        ".set noat             \n"
+        "sw    $16,  0(%0)     \n" /* s0 */
+        "sw    $17,  4(%0)     \n" /* s1 */
+        "sw    $18,  8(%0)     \n" /* s2 */
+        "sw    $19, 12(%0)     \n" /* s3 */
+        "sw    $20, 16(%0)     \n" /* s4 */
+        "sw    $21, 20(%0)     \n" /* s5 */
+        "sw    $22, 24(%0)     \n" /* s6 */
+        "sw    $23, 28(%0)     \n" /* s7 */
+        "sw    $30, 32(%0)     \n" /* fp */
+        "sw    $29, 36(%0)     \n" /* sp */
+        "sw    $31, 40(%0)     \n" /* ra */
+        ".set at               \n"
+        ".set reorder          \n"
+        : : "r" (addr)
+    );
+}
+/*---------------------------------------------------------------------------
+ * Load non-volatile context.
+ *---------------------------------------------------------------------------
+ */
+static inline void load_context(const void* addr)
+{
+    asm volatile (
+        ".set noat             \n"
+        ".set noreorder        \n"
+        "lw    $8, 44(%0)      \n" /* Get start address ($8 = t0) */
+        "beqz  $8, running     \n" /* NULL -> already running */
+        "nop                   \n"
+        "jr    $8              \n"
+        "move  $9, %0          \n" /* t1 = context */
+    "running:                  \n"
+        "lw    $16,  0(%0)     \n" /* s0 */
+        "lw    $17,  4(%0)     \n" /* s1 */
+        "lw    $18,  8(%0)     \n" /* s2 */
+        "lw    $19, 12(%0)     \n" /* s3 */
+        "lw    $20, 16(%0)     \n" /* s4 */
+        "lw    $21, 20(%0)     \n" /* s5 */
+        "lw    $22, 24(%0)     \n" /* s6 */
+        "lw    $23, 28(%0)     \n" /* s7 */
+        "lw    $30, 32(%0)     \n" /* fp */
+        "lw    $29, 36(%0)     \n" /* sp */
+        "lw    $31, 40(%0)     \n" /* ra */
+        ".set at               \n"
+        ".set reorder          \n"
+        : : "r" (addr) : "t0", "t1"
+    );
+}

diff --git a/firmware/asm/mips/thread-mips32.c b/firmware/asm/mips/thread-mips32.c new file mode 100644 index 0000000000..e754df7e29 --- /dev/null +++ b/firmware/asm/mips/thread-mips32.c
@@ -0,0 +1,111 @@
	1	/***************************************************************************
	2	* __________ __ ___.
	3	* Open \______ \ ____ ____ \| \| _\_ \|__ _______ ___
	4	* Source \| _// _ \_/ ___\\| \|/ /\| __ \ / _ \ \/ /
	5	* Jukebox \| \| ( <_> ) \___\| < \| \_\ ( <_> > < <
	6	* Firmware \|____\|_ /\____/ \___ >__\|_ \\|___ /\____/__/\_ \
	7	* \/ \/ \/ \/ \/
	8	* $Id$
	9	*
	10	* Copyright (C) 2008 by Maurus Cuelenaere
	11	*
	12	* 32-bit MIPS threading support
	13	*
	14	* This program is free software; you can redistribute it and/or
	15	* modify it under the terms of the GNU General Public License
	16	* as published by the Free Software Foundation; either version 2
	17	* of the License, or (at your option) any later version.
	18	*
	19	* This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
	20	* KIND, either express or implied.
	21	*
	22	****************************************************************************/
	23
	24	/*---------------------------------------------------------------------------
	25	* Start the thread running and terminate it if it returns
	26	*---------------------------------------------------------------------------
	27	*/
	28
	29	void start_thread(void); /* Provide C access to ASM label */
	30	static void USED_ATTR _start_thread(void)
	31	{
	32	/* t1 = context */
	33	asm volatile (
	34	"start_thread: \n"
	35	".set noreorder \n"
	36	".set noat \n"
	37	"lw $8, 4($9) \n" /* Fetch thread function pointer ($8 = t0, $9 = t1) */
	38	"lw $29, 36($9) \n" /* Set initial sp(=$29) */
	39	"jalr $8 \n" /* Start the thread */
	40	"sw $0, 44($9) \n" /* Clear start address */
	41	".set at \n"
	42	".set reorder \n"
	43	);
	44	thread_exit();
	45	}
	46
	47	/* Place context pointer in s0 slot, function pointer in s1 slot, and
	48	* start_thread pointer in context_start */
	49	#define THREAD_STARTUP_INIT(core, thread, function) \
	50	({ (thread)->context.r[0] = (uint32_t)&(thread)->context, \
	51	(thread)->context.r[1] = (uint32_t)(function), \
	52	(thread)->context.start = (uint32_t)start_thread; })
	53
	54	/*---------------------------------------------------------------------------
	55	* Store non-volatile context.
	56	*---------------------------------------------------------------------------
	57	*/
	58	static inline void store_context(void* addr)
	59	{
	60	asm volatile (
	61	".set noreorder \n"
	62	".set noat \n"
	63	"sw $16, 0(%0) \n" /* s0 */
	64	"sw $17, 4(%0) \n" /* s1 */
	65	"sw $18, 8(%0) \n" /* s2 */
	66	"sw $19, 12(%0) \n" /* s3 */
	67	"sw $20, 16(%0) \n" /* s4 */
	68	"sw $21, 20(%0) \n" /* s5 */
	69	"sw $22, 24(%0) \n" /* s6 */
	70	"sw $23, 28(%0) \n" /* s7 */
	71	"sw $30, 32(%0) \n" /* fp */
	72	"sw $29, 36(%0) \n" /* sp */
	73	"sw $31, 40(%0) \n" /* ra */
	74	".set at \n"
	75	".set reorder \n"
	76	: : "r" (addr)
	77	);
	78	}
	79
	80	/*---------------------------------------------------------------------------
	81	* Load non-volatile context.
	82	*---------------------------------------------------------------------------
	83	*/
	84	static inline void load_context(const void* addr)
	85	{
	86	asm volatile (
	87	".set noat \n"
	88	".set noreorder \n"
	89	"lw $8, 44(%0) \n" /* Get start address ($8 = t0) */
	90	"beqz $8, running \n" /* NULL -> already running */
	91	"nop \n"
	92	"jr $8 \n"
	93	"move $9, %0 \n" /* t1 = context */
	94	"running: \n"
	95	"lw $16, 0(%0) \n" /* s0 */
	96	"lw $17, 4(%0) \n" /* s1 */
	97	"lw $18, 8(%0) \n" /* s2 */
	98	"lw $19, 12(%0) \n" /* s3 */
	99	"lw $20, 16(%0) \n" /* s4 */
	100	"lw $21, 20(%0) \n" /* s5 */
	101	"lw $22, 24(%0) \n" /* s6 */
	102	"lw $23, 28(%0) \n" /* s7 */
	103	"lw $30, 32(%0) \n" /* fp */
	104	"lw $29, 36(%0) \n" /* sp */
	105	"lw $31, 40(%0) \n" /* ra */
	106	".set at \n"
	107	".set reorder \n"
	108	: : "r" (addr) : "t0", "t1"
	109	);
	110	}
	111