| 1 | |
| 2 | |
| 3 | * arch/alpha/lib/fpreg.c
|
| 4 | *
|
| 5 | * (C) Copyright 1998 Linus Torvalds
|
| 6 |
|
| 7 |
|
| 8 | #include <linux/compiler.h>
|
| 9 | #include <linux/export.h>
|
| 10 | #include <linux/preempt.h>
|
| 11 | #include <asm/fpu.h>
|
| 12 | #include <asm/thread_info.h>
|
| 13 |
|
| 14 | #if defined(CONFIG_ALPHA_EV6) || defined(CONFIG_ALPHA_EV67)
|
| 15 | #define STT(reg,val) asm volatile ("ftoit $f"#reg",%0" : "=r"(val));
|
| 16 | #else
|
| 17 | #define STT(reg,val) asm volatile ("stt $f"#reg",%0" : "=m"(val));
|
| 18 | #endif
|
| 19 |
|
| 20 | unsigned long
|
| 21 | alpha_read_fp_reg (unsigned long reg)
|
| 22 | {
|
| 23 | unsigned long val;
|
| 24 |
|
| 25 | if (unlikely(reg >= 32))
|
| 26 | return 0;
|
| 27 | preempt_disable();
|
| 28 | if (current_thread_info()->status & TS_SAVED_FP)
|
| 29 | val = current_thread_info()->fp[reg];
|
| 30 | else switch (reg) {
|
| 31 | case 0: STT( 0, val); break;
|
| 32 | case 1: STT( 1, val); break;
|
| 33 | case 2: STT( 2, val); break;
|
| 34 | case 3: STT( 3, val); break;
|
| 35 | case 4: STT( 4, val); break;
|
| 36 | case 5: STT( 5, val); break;
|
| 37 | case 6: STT( 6, val); break;
|
| 38 | case 7: STT( 7, val); break;
|
| 39 | case 8: STT( 8, val); break;
|
| 40 | case 9: STT( 9, val); break;
|
| 41 | case 10: STT(10, val); break;
|
| 42 | case 11: STT(11, val); break;
|
| 43 | case 12: STT(12, val); break;
|
| 44 | case 13: STT(13, val); break;
|
| 45 | case 14: STT(14, val); break;
|
| 46 | case 15: STT(15, val); break;
|
| 47 | case 16: STT(16, val); break;
|
| 48 | case 17: STT(17, val); break;
|
| 49 | case 18: STT(18, val); break;
|
| 50 | case 19: STT(19, val); break;
|
| 51 | case 20: STT(20, val); break;
|
| 52 | case 21: STT(21, val); break;
|
| 53 | case 22: STT(22, val); break;
|
| 54 | case 23: STT(23, val); break;
|
| 55 | case 24: STT(24, val); break;
|
| 56 | case 25: STT(25, val); break;
|
| 57 | case 26: STT(26, val); break;
|
| 58 | case 27: STT(27, val); break;
|
| 59 | case 28: STT(28, val); break;
|
| 60 | case 29: STT(29, val); break;
|
| 61 | case 30: STT(30, val); break;
|
| 62 | case 31: STT(31, val); break;
|
| 63 | }
|
| 64 | preempt_enable();
|
| 65 | return val;
|
| 66 | }
|
| 67 | EXPORT_SYMBOL(alpha_read_fp_reg);
|
| 68 |
|
| 69 | #if defined(CONFIG_ALPHA_EV6) || defined(CONFIG_ALPHA_EV67)
|
| 70 | #define LDT(reg,val) asm volatile ("itoft %0,$f"#reg : : "r"(val));
|
| 71 | #else
|
| 72 | #define LDT(reg,val) asm volatile ("ldt $f"#reg",%0" : : "m"(val));
|
| 73 | #endif
|
| 74 |
|
| 75 | void
|
| 76 | alpha_write_fp_reg (unsigned long reg, unsigned long val)
|
| 77 | {
|
| 78 | if (unlikely(reg >= 32))
|
| 79 | return;
|
| 80 |
|
| 81 | preempt_disable();
|
| 82 | if (current_thread_info()->status & TS_SAVED_FP) {
|
| 83 | current_thread_info()->status |= TS_RESTORE_FP;
|
| 84 | current_thread_info()->fp[reg] = val;
|
| 85 | } else switch (reg) {
|
| 86 | case 0: LDT( 0, val); break;
|
| 87 | case 1: LDT( 1, val); break;
|
| 88 | case 2: LDT( 2, val); break;
|
| 89 | case 3: LDT( 3, val); break;
|
| 90 | case 4: LDT( 4, val); break;
|
| 91 | case 5: LDT( 5, val); break;
|
| 92 | case 6: LDT( 6, val); break;
|
| 93 | case 7: LDT( 7, val); break;
|
| 94 | case 8: LDT( 8, val); break;
|
| 95 | case 9: LDT( 9, val); break;
|
| 96 | case 10: LDT(10, val); break;
|
| 97 | case 11: LDT(11, val); break;
|
| 98 | case 12: LDT(12, val); break;
|
| 99 | case 13: LDT(13, val); break;
|
| 100 | case 14: LDT(14, val); break;
|
| 101 | case 15: LDT(15, val); break;
|
| 102 | case 16: LDT(16, val); break;
|
| 103 | case 17: LDT(17, val); break;
|
| 104 | case 18: LDT(18, val); break;
|
| 105 | case 19: LDT(19, val); break;
|
| 106 | case 20: LDT(20, val); break;
|
| 107 | case 21: LDT(21, val); break;
|
| 108 | case 22: LDT(22, val); break;
|
| 109 | case 23: LDT(23, val); break;
|
| 110 | case 24: LDT(24, val); break;
|
| 111 | case 25: LDT(25, val); break;
|
| 112 | case 26: LDT(26, val); break;
|
| 113 | case 27: LDT(27, val); break;
|
| 114 | case 28: LDT(28, val); break;
|
| 115 | case 29: LDT(29, val); break;
|
| 116 | case 30: LDT(30, val); break;
|
| 117 | case 31: LDT(31, val); break;
|
| 118 | }
|
| 119 | preempt_enable();
|
| 120 | }
|
| 121 | EXPORT_SYMBOL(alpha_write_fp_reg);
|
| 122 |
|
| 123 | #if defined(CONFIG_ALPHA_EV6) || defined(CONFIG_ALPHA_EV67)
|
| 124 | #define STS(reg,val) asm volatile ("ftois $f"#reg",%0" : "=r"(val));
|
| 125 | #else
|
| 126 | #define STS(reg,val) asm volatile ("sts $f"#reg",%0" : "=m"(val));
|
| 127 | #endif
|
| 128 |
|
| 129 | unsigned long
|
| 130 | alpha_read_fp_reg_s (unsigned long reg)
|
| 131 | {
|
| 132 | unsigned long val;
|
| 133 |
|
| 134 | if (unlikely(reg >= 32))
|
| 135 | return 0;
|
| 136 |
|
| 137 | preempt_disable();
|
| 138 | if (current_thread_info()->status & TS_SAVED_FP) {
|
| 139 | LDT(0, current_thread_info()->fp[reg]);
|
| 140 | STS(0, val);
|
| 141 | } else switch (reg) {
|
| 142 | case 0: STS( 0, val); break;
|
| 143 | case 1: STS( 1, val); break;
|
| 144 | case 2: STS( 2, val); break;
|
| 145 | case 3: STS( 3, val); break;
|
| 146 | case 4: STS( 4, val); break;
|
| 147 | case 5: STS( 5, val); break;
|
| 148 | case 6: STS( 6, val); break;
|
| 149 | case 7: STS( 7, val); break;
|
| 150 | case 8: STS( 8, val); break;
|
| 151 | case 9: STS( 9, val); break;
|
| 152 | case 10: STS(10, val); break;
|
| 153 | case 11: STS(11, val); break;
|
| 154 | case 12: STS(12, val); break;
|
| 155 | case 13: STS(13, val); break;
|
| 156 | case 14: STS(14, val); break;
|
| 157 | case 15: STS(15, val); break;
|
| 158 | case 16: STS(16, val); break;
|
| 159 | case 17: STS(17, val); break;
|
| 160 | case 18: STS(18, val); break;
|
| 161 | case 19: STS(19, val); break;
|
| 162 | case 20: STS(20, val); break;
|
| 163 | case 21: STS(21, val); break;
|
| 164 | case 22: STS(22, val); break;
|
| 165 | case 23: STS(23, val); break;
|
| 166 | case 24: STS(24, val); break;
|
| 167 | case 25: STS(25, val); break;
|
| 168 | case 26: STS(26, val); break;
|
| 169 | case 27: STS(27, val); break;
|
| 170 | case 28: STS(28, val); break;
|
| 171 | case 29: STS(29, val); break;
|
| 172 | case 30: STS(30, val); break;
|
| 173 | case 31: STS(31, val); break;
|
| 174 | }
|
| 175 | preempt_enable();
|
| 176 | return val;
|
| 177 | }
|
| 178 | EXPORT_SYMBOL(alpha_read_fp_reg_s);
|
| 179 |
|
| 180 | #if defined(CONFIG_ALPHA_EV6) || defined(CONFIG_ALPHA_EV67)
|
| 181 | #define LDS(reg,val) asm volatile ("itofs %0,$f"#reg : : "r"(val));
|
| 182 | #else
|
| 183 | #define LDS(reg,val) asm volatile ("lds $f"#reg",%0" : : "m"(val));
|
| 184 | #endif
|
| 185 |
|
| 186 | void
|
| 187 | alpha_write_fp_reg_s (unsigned long reg, unsigned long val)
|
| 188 | {
|
| 189 | if (unlikely(reg >= 32))
|
| 190 | return;
|
| 191 |
|
| 192 | preempt_disable();
|
| 193 | if (current_thread_info()->status & TS_SAVED_FP) {
|
| 194 | current_thread_info()->status |= TS_RESTORE_FP;
|
| 195 | LDS(0, val);
|
| 196 | STT(0, current_thread_info()->fp[reg]);
|
| 197 | } else switch (reg) {
|
| 198 | case 0: LDS( 0, val); break;
|
| 199 | case 1: LDS( 1, val); break;
|
| 200 | case 2: LDS( 2, val); break;
|
| 201 | case 3: LDS( 3, val); break;
|
| 202 | case 4: LDS( 4, val); break;
|
| 203 | case 5: LDS( 5, val); break;
|
| 204 | case 6: LDS( 6, val); break;
|
| 205 | case 7: LDS( 7, val); break;
|
| 206 | case 8: LDS( 8, val); break;
|
| 207 | case 9: LDS( 9, val); break;
|
| 208 | case 10: LDS(10, val); break;
|
| 209 | case 11: LDS(11, val); break;
|
| 210 | case 12: LDS(12, val); break;
|
| 211 | case 13: LDS(13, val); break;
|
| 212 | case 14: LDS(14, val); break;
|
| 213 | case 15: LDS(15, val); break;
|
| 214 | case 16: LDS(16, val); break;
|
| 215 | case 17: LDS(17, val); break;
|
| 216 | case 18: LDS(18, val); break;
|
| 217 | case 19: LDS(19, val); break;
|
| 218 | case 20: LDS(20, val); break;
|
| 219 | case 21: LDS(21, val); break;
|
| 220 | case 22: LDS(22, val); break;
|
| 221 | case 23: LDS(23, val); break;
|
| 222 | case 24: LDS(24, val); break;
|
| 223 | case 25: LDS(25, val); break;
|
| 224 | case 26: LDS(26, val); break;
|
| 225 | case 27: LDS(27, val); break;
|
| 226 | case 28: LDS(28, val); break;
|
| 227 | case 29: LDS(29, val); break;
|
| 228 | case 30: LDS(30, val); break;
|
| 229 | case 31: LDS(31, val); break;
|
| 230 | }
|
| 231 | preempt_enable();
|
| 232 | }
|
| 233 | EXPORT_SYMBOL(alpha_write_fp_reg_s);
|