C6X: time management
[linux-3.10.git] / arch / c6x / kernel / switch_to.S
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          */
20 ENTRY(__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
74 ENDPROC(__switch_to)