1/*
2 *  Copyright (C) 2011 Texas Instruments Incorporated
3 *  Author: Mark Salter (msalter@redhat.com)
4 *
5 *  This program is free software; you can redistribute it and/or modify
6 *  it under the terms of the GNU General Public License version 2 as
7 *  published by the Free Software Foundation.
8 */
9
10#include <linux/linkage.h>
11#include <asm/asm-offsets.h>
12
13#define SP	B15
14
15	/*
16	 * void __switch_to(struct thread_info *prev,
17	 *      	    struct thread_info *next,
18	 *		    struct task_struct *tsk) ;
19	 */
20ENTRY(__switch_to)
21	LDDW	.D2T2	*+B4(THREAD_B15_14),B7:B6
22 ||	MV	.L2X	A4,B5	; prev
23 ||	MV	.L1X	B4,A5	; next
24 ||	MVC	.S2	RILC,B1
25
26	STW	.D2T2	B3,*+B5(THREAD_PC)
27 ||	STDW	.D1T1	A13:A12,*+A4(THREAD_A13_12)
28 ||	MVC	.S2	ILC,B0
29
30	LDW	.D2T2	*+B4(THREAD_PC),B3
31 ||	LDDW	.D1T1	*+A5(THREAD_A13_12),A13:A12
32
33	STDW	.D1T1	A11:A10,*+A4(THREAD_A11_10)
34 ||	STDW	.D2T2	B1:B0,*+B5(THREAD_RICL_ICL)
35#ifndef __DSBT__
36 ||	MVKL	.S2	current_ksp,B1
37#endif
38
39	STDW	.D2T2	B15:B14,*+B5(THREAD_B15_14)
40 ||	STDW	.D1T1	A15:A14,*+A4(THREAD_A15_14)
41#ifndef __DSBT__
42 ||	MVKH	.S2	current_ksp,B1
43#endif
44
45	;; Switch to next SP
46	MV	.S2	B7,SP
47#ifdef __DSBT__
48 ||	STW	.D2T2	B7,*+B14(current_ksp)
49#else
50 ||	STW	.D2T2	B7,*B1
51 ||	MV	.L2	B6,B14
52#endif
53 ||	LDDW	.D1T1	*+A5(THREAD_RICL_ICL),A1:A0
54
55	STDW	.D2T2	B11:B10,*+B5(THREAD_B11_10)
56 ||	LDDW	.D1T1	*+A5(THREAD_A15_14),A15:A14
57
58	STDW	.D2T2	B13:B12,*+B5(THREAD_B13_12)
59 ||	LDDW	.D1T1	*+A5(THREAD_A11_10),A11:A10
60
61	B	.S2	B3		; return in next E1
62 ||	LDDW	.D2T2	*+B4(THREAD_B13_12),B13:B12
63
64	LDDW	.D2T2	*+B4(THREAD_B11_10),B11:B10
65	NOP
66
67	MV	.L2X	A0,B0
68 ||	MV	.S1	A6,A4
69
70	MVC	.S2	B0,ILC
71 ||	MV	.L2X	A1,B1
72
73	MVC	.S2	B1,RILC
74ENDPROC(__switch_to)
75