75 lines
1.6 KiB
ArmAsm
75 lines
1.6 KiB
ArmAsm
/*
|
|
* 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)
|