| 40 | } |
| 41 | |
| 42 | OSErrorHandler OSSetErrorHandler(OSError error, OSErrorHandler handler) { |
| 43 | OSErrorHandler oldHandler; |
| 44 | BOOL enabled; |
| 45 | |
| 46 | enabled = OSDisableInterrupts(); |
| 47 | oldHandler = __OSErrorTable[error]; |
| 48 | __OSErrorTable[error] = handler; |
| 49 | |
| 50 | if (error == OS_ERROR_FPE) { |
| 51 | u32 msr; |
| 52 | u32 fpscr; |
| 53 | OSThread* thread; |
| 54 | |
| 55 | msr = PPCMfmsr(); |
| 56 | PPCMtmsr(msr | MSR_FP); |
| 57 | fpscr = PPCMffpscr(); |
| 58 | if (handler) { |
| 59 | for (thread = __OSActiveThreadQueue.head; thread; thread = thread->linkActive.next) { |
| 60 | thread->context.srr1 |= MSR_FE0 | MSR_FE1; |
| 61 | if ((thread->context.state & OS_CONTEXT_STATE_FPSAVED) == 0) { |
| 62 | int i; |
| 63 | thread->context.state |= OS_CONTEXT_STATE_FPSAVED; |
| 64 | for (i = 0; i < 32; ++i) { |
| 65 | *(u64*)&thread->context.fpr[i] = (u64)0xffffffffffffffffLL; |
| 66 | *(u64*)&thread->context.psf[i] = (u64)0xffffffffffffffffLL; |
| 67 | } |
| 68 | thread->context.fpscr = FPSCR_NI; |
| 69 | } |
| 70 | thread->context.fpscr |= __OSFpscrEnableBits & FPSCR_ENABLE; |
| 71 | thread->context.fpscr &= |
| 72 | ~(FPSCR_VXVC | FPSCR_VXIMZ | FPSCR_VXZDZ | FPSCR_VXIDI | FPSCR_VXISI | FPSCR_VXSNAN | |
| 73 | FPSCR_VXSOFT | FPSCR_VXSQRT | FPSCR_VXCVI | FPSCR_XX | FPSCR_ZX | FPSCR_UX | |
| 74 | FPSCR_OX | FPSCR_FX | FPSCR_FI); |
| 75 | } |
| 76 | fpscr |= __OSFpscrEnableBits & FPSCR_ENABLE; |
| 77 | msr |= MSR_FE0 | MSR_FE1; |
| 78 | } else { |
| 79 | for (thread = __OSActiveThreadQueue.head; thread; thread = thread->linkActive.next) { |
| 80 | thread->context.srr1 &= ~(MSR_FE0 | MSR_FE1); |
| 81 | thread->context.fpscr &= ~FPSCR_ENABLE; |
| 82 | thread->context.fpscr &= |
| 83 | ~(FPSCR_VXVC | FPSCR_VXIMZ | FPSCR_VXZDZ | FPSCR_VXIDI | FPSCR_VXISI | FPSCR_VXSNAN | |
| 84 | FPSCR_VXSOFT | FPSCR_VXSQRT | FPSCR_VXCVI | FPSCR_XX | FPSCR_ZX | FPSCR_UX | |
| 85 | FPSCR_OX | FPSCR_FX | FPSCR_FI); |
| 86 | } |
| 87 | fpscr &= ~FPSCR_ENABLE; |
| 88 | msr &= ~(MSR_FE0 | MSR_FE1); |
| 89 | } |
| 90 | |
| 91 | fpscr &= ~(FPSCR_VXVC | FPSCR_VXIMZ | FPSCR_VXZDZ | FPSCR_VXIDI | FPSCR_VXISI | FPSCR_VXSNAN | |
| 92 | FPSCR_VXSOFT | FPSCR_VXSQRT | FPSCR_VXCVI | FPSCR_XX | FPSCR_ZX | FPSCR_UX | |
| 93 | FPSCR_OX | FPSCR_FX | FPSCR_FI); |
| 94 | |
| 95 | PPCMtfpscr(fpscr); |
| 96 | PPCMtmsr(msr); |
| 97 | } |
| 98 | |
| 99 | OSRestoreInterrupts(enabled); |
no test coverage detected