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