James Hogan | 027f891 | 2012-09-21 17:40:06 +0100 | [diff] [blame] | 1 | /* |
| 2 | * tbidspram.S |
| 3 | * |
| 4 | * Copyright (C) 2009, 2012 Imagination Technologies. |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify it under |
| 7 | * the terms of the GNU General Public License version 2 as published by the |
| 8 | * Free Software Foundation. |
| 9 | * |
| 10 | * Explicit state save and restore routines forming part of the thread binary |
| 11 | * interface for META processors |
| 12 | */ |
| 13 | |
| 14 | .file "tbidspram.S" |
| 15 | |
| 16 | /* These aren't generally useful to a user so for now, they arent publically available */ |
| 17 | #define _TBIECH_DSPRAM_DUA_S 8 |
| 18 | #define _TBIECH_DSPRAM_DUA_BITS 0x7f00 |
| 19 | #define _TBIECH_DSPRAM_DUB_S 0 |
| 20 | #define _TBIECH_DSPRAM_DUB_BITS 0x007f |
| 21 | |
| 22 | /* |
| 23 | * void *__TBIDspramSaveA( short DspramSizes, void *pExt ) |
| 24 | */ |
| 25 | .text |
| 26 | .balign 4 |
| 27 | .global ___TBIDspramSaveA |
| 28 | .type ___TBIDspramSaveA,function |
| 29 | ___TBIDspramSaveA: |
| 30 | |
| 31 | SETL [A0StP++], D0.5, D1.5 |
| 32 | MOV A0.3, D0Ar2 |
| 33 | |
| 34 | /* D1Ar1 - Dspram Sizes |
| 35 | * A0.4 - Pointer to buffer |
| 36 | */ |
| 37 | |
| 38 | /* Save the specified amount of dspram DUA */ |
| 39 | DL MOV D0AR.0, #0 |
| 40 | LSR D1Ar1, D1Ar1, #_TBIECH_DSPRAM_DUA_S |
| 41 | AND D1Ar1, D1Ar1, #(_TBIECH_DSPRAM_DUA_BITS >> _TBIECH_DSPRAM_DUA_S) |
| 42 | SUB TXRPT, D1Ar1, #1 |
| 43 | $L1: |
| 44 | DL MOV D0Re0, [D0AR.0++] |
| 45 | DL MOV D0Ar6, [D0AR.0++] |
| 46 | DL MOV D0Ar4, [D0AR.0++] |
| 47 | DL MOV D0.5, [D0AR.0++] |
| 48 | MSETL [A0.3++], D0Re0, D0Ar6, D0Ar4, D0.5 |
| 49 | |
| 50 | BR $L1 |
| 51 | |
| 52 | GETL D0.5, D1.5, [--A0StP] |
| 53 | MOV PC, D1RtP |
| 54 | |
| 55 | .size ___TBIDspramSaveA,.-___TBIDspramSaveA |
| 56 | |
| 57 | /* |
| 58 | * void *__TBIDspramSaveB( short DspramSizes, void *pExt ) |
| 59 | */ |
| 60 | .balign 4 |
| 61 | .global ___TBIDspramSaveB |
| 62 | .type ___TBIDspramSaveB,function |
| 63 | ___TBIDspramSaveB: |
| 64 | |
| 65 | SETL [A0StP++], D0.5, D1.5 |
| 66 | MOV A0.3, D0Ar2 |
| 67 | |
| 68 | /* D1Ar1 - Dspram Sizes |
| 69 | * A0.3 - Pointer to buffer |
| 70 | */ |
| 71 | |
| 72 | /* Save the specified amount of dspram DUA */ |
| 73 | DL MOV D0BR.0, #0 |
| 74 | LSR D1Ar1, D1Ar1, #_TBIECH_DSPRAM_DUB_S |
| 75 | AND D1Ar1, D1Ar1, #(_TBIECH_DSPRAM_DUB_BITS >> _TBIECH_DSPRAM_DUB_S) |
| 76 | SUB TXRPT, D1Ar1, #1 |
| 77 | $L2: |
| 78 | DL MOV D0Re0, [D0BR.0++] |
| 79 | DL MOV D0Ar6, [D0BR.0++] |
| 80 | DL MOV D0Ar4, [D0BR.0++] |
| 81 | DL MOV D0.5, [D0BR.0++] |
| 82 | MSETL [A0.3++], D0Re0, D0Ar6, D0Ar4, D0.5 |
| 83 | |
| 84 | BR $L2 |
| 85 | |
| 86 | GETL D0.5, D1.5, [--A0StP] |
| 87 | MOV PC, D1RtP |
| 88 | |
| 89 | .size ___TBIDspramSaveB,.-___TBIDspramSaveB |
| 90 | |
| 91 | /* |
| 92 | * void *__TBIDspramRestoreA( short DspramSizes, void *pExt ) |
| 93 | */ |
| 94 | .balign 4 |
| 95 | .global ___TBIDspramRestoreA |
| 96 | .type ___TBIDspramRestoreA,function |
| 97 | ___TBIDspramRestoreA: |
| 98 | |
| 99 | SETL [A0StP++], D0.5, D1.5 |
| 100 | MOV A0.3, D0Ar2 |
| 101 | |
| 102 | /* D1Ar1 - Dspram Sizes |
| 103 | * A0.3 - Pointer to buffer |
| 104 | */ |
| 105 | |
| 106 | /* Restore the specified amount of dspram DUA */ |
| 107 | DL MOV D0AW.0, #0 |
| 108 | LSR D1Ar1, D1Ar1, #_TBIECH_DSPRAM_DUA_S |
| 109 | AND D1Ar1, D1Ar1, #(_TBIECH_DSPRAM_DUA_BITS >> _TBIECH_DSPRAM_DUA_S) |
| 110 | SUB TXRPT, D1Ar1, #1 |
| 111 | $L3: |
| 112 | MGETL D0Re0, D0Ar6, D0Ar4, D0.5, [A0.3++] |
| 113 | DL MOV [D0AW.0++], D0Re0 |
| 114 | DL MOV [D0AW.0++], D0Ar6 |
| 115 | DL MOV [D0AW.0++], D0Ar4 |
| 116 | DL MOV [D0AW.0++], D0.5 |
| 117 | |
| 118 | BR $L3 |
| 119 | |
| 120 | GETL D0.5, D1.5, [--A0StP] |
| 121 | MOV PC, D1RtP |
| 122 | |
| 123 | .size ___TBIDspramRestoreA,.-___TBIDspramRestoreA |
| 124 | |
| 125 | /* |
| 126 | * void *__TBIDspramRestoreB( short DspramSizes, void *pExt ) |
| 127 | */ |
| 128 | .balign 4 |
| 129 | .global ___TBIDspramRestoreB |
| 130 | .type ___TBIDspramRestoreB,function |
| 131 | ___TBIDspramRestoreB: |
| 132 | |
| 133 | SETL [A0StP++], D0.5, D1.5 |
| 134 | MOV A0.3, D0Ar2 |
| 135 | |
| 136 | /* D1Ar1 - Dspram Sizes |
| 137 | * A0.3 - Pointer to buffer |
| 138 | */ |
| 139 | |
| 140 | /* Restore the specified amount of dspram DUA */ |
| 141 | DL MOV D0BW.0, #0 |
| 142 | LSR D1Ar1, D1Ar1, #_TBIECH_DSPRAM_DUB_S |
| 143 | AND D1Ar1, D1Ar1, #(_TBIECH_DSPRAM_DUB_BITS >> _TBIECH_DSPRAM_DUB_S) |
| 144 | SUB TXRPT, D1Ar1, #1 |
| 145 | $L4: |
| 146 | MGETL D0Re0, D0Ar6, D0Ar4, D0.5, [A0.3++] |
| 147 | DL MOV [D0BW.0++], D0Re0 |
| 148 | DL MOV [D0BW.0++], D0Ar6 |
| 149 | DL MOV [D0BW.0++], D0Ar4 |
| 150 | DL MOV [D0BW.0++], D0.5 |
| 151 | |
| 152 | BR $L4 |
| 153 | |
| 154 | GETL D0.5, D1.5, [--A0StP] |
| 155 | MOV PC, D1RtP |
| 156 | |
| 157 | .size ___TBIDspramRestoreB,.-___TBIDspramRestoreB |
| 158 | |
| 159 | /* |
| 160 | * End of tbidspram.S |
| 161 | */ |