| /* |
| * Copyright (C) 2011 Texas Instruments Incorporated |
| * Author: Mark Salter (msalter@redhat.com) |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| */ |
| |
| #include <linux/linkage.h> |
| #include <asm/asm-offsets.h> |
| |
| #define SP B15 |
| |
| /* |
| * void __switch_to(struct thread_info *prev, |
| * struct thread_info *next, |
| * struct task_struct *tsk) ; |
| */ |
| ENTRY(__switch_to) |
| LDDW .D2T2 *+B4(THREAD_B15_14),B7:B6 |
| || MV .L2X A4,B5 ; prev |
| || MV .L1X B4,A5 ; next |
| || MVC .S2 RILC,B1 |
| |
| STW .D2T2 B3,*+B5(THREAD_PC) |
| || STDW .D1T1 A13:A12,*+A4(THREAD_A13_12) |
| || MVC .S2 ILC,B0 |
| |
| LDW .D2T2 *+B4(THREAD_PC),B3 |
| || LDDW .D1T1 *+A5(THREAD_A13_12),A13:A12 |
| |
| STDW .D1T1 A11:A10,*+A4(THREAD_A11_10) |
| || STDW .D2T2 B1:B0,*+B5(THREAD_RICL_ICL) |
| #ifndef __DSBT__ |
| || MVKL .S2 current_ksp,B1 |
| #endif |
| |
| STDW .D2T2 B15:B14,*+B5(THREAD_B15_14) |
| || STDW .D1T1 A15:A14,*+A4(THREAD_A15_14) |
| #ifndef __DSBT__ |
| || MVKH .S2 current_ksp,B1 |
| #endif |
| |
| ;; Switch to next SP |
| MV .S2 B7,SP |
| #ifdef __DSBT__ |
| || STW .D2T2 B7,*+B14(current_ksp) |
| #else |
| || STW .D2T2 B7,*B1 |
| || MV .L2 B6,B14 |
| #endif |
| || LDDW .D1T1 *+A5(THREAD_RICL_ICL),A1:A0 |
| |
| STDW .D2T2 B11:B10,*+B5(THREAD_B11_10) |
| || LDDW .D1T1 *+A5(THREAD_A15_14),A15:A14 |
| |
| STDW .D2T2 B13:B12,*+B5(THREAD_B13_12) |
| || LDDW .D1T1 *+A5(THREAD_A11_10),A11:A10 |
| |
| B .S2 B3 ; return in next E1 |
| || LDDW .D2T2 *+B4(THREAD_B13_12),B13:B12 |
| |
| LDDW .D2T2 *+B4(THREAD_B11_10),B11:B10 |
| NOP |
| |
| MV .L2X A0,B0 |
| || MV .S1 A6,A4 |
| |
| MVC .S2 B0,ILC |
| || MV .L2X A1,B1 |
| |
| MVC .S2 B1,RILC |
| ENDPROC(__switch_to) |
