| /* SPDX-License-Identifier: GPL-2.0 */ |
| #ifndef _ASM_MATH_EMU_H |
| #define _ASM_MATH_EMU_H |
| |
| #include <asm/setup.h> |
| #include <linux/linkage.h> |
| |
| /* Status Register bits */ |
| |
| /* accrued exception bits */ |
| #define FPSR_AEXC_INEX 3 |
| #define FPSR_AEXC_DZ 4 |
| #define FPSR_AEXC_UNFL 5 |
| #define FPSR_AEXC_OVFL 6 |
| #define FPSR_AEXC_IOP 7 |
| |
| /* exception status bits */ |
| #define FPSR_EXC_INEX1 8 |
| #define FPSR_EXC_INEX2 9 |
| #define FPSR_EXC_DZ 10 |
| #define FPSR_EXC_UNFL 11 |
| #define FPSR_EXC_OVFL 12 |
| #define FPSR_EXC_OPERR 13 |
| #define FPSR_EXC_SNAN 14 |
| #define FPSR_EXC_BSUN 15 |
| |
| /* quotient byte, assumes big-endian, of course */ |
| #define FPSR_QUOTIENT(fpsr) (*((signed char *) &(fpsr) + 1)) |
| |
| /* condition code bits */ |
| #define FPSR_CC_NAN 24 |
| #define FPSR_CC_INF 25 |
| #define FPSR_CC_Z 26 |
| #define FPSR_CC_NEG 27 |
| |
| |
| /* Control register bits */ |
| |
| /* rounding mode */ |
| #define FPCR_ROUND_RN 0 /* round to nearest/even */ |
| #define FPCR_ROUND_RZ 1 /* round to zero */ |
| #define FPCR_ROUND_RM 2 /* minus infinity */ |
| #define FPCR_ROUND_RP 3 /* plus infinity */ |
| |
| /* rounding precision */ |
| #define FPCR_PRECISION_X 0 /* long double */ |
| #define FPCR_PRECISION_S 1 /* double */ |
| #define FPCR_PRECISION_D 2 /* float */ |
| |
| |
| /* Flags to select the debugging output */ |
| #define PDECODE 0 |
| #define PEXECUTE 1 |
| #define PCONV 2 |
| #define PNORM 3 |
| #define PREGISTER 4 |
| #define PINSTR 5 |
| #define PUNIMPL 6 |
| #define PMOVEM 7 |
| |
| #define PMDECODE (1<<PDECODE) |
| #define PMEXECUTE (1<<PEXECUTE) |
| #define PMCONV (1<<PCONV) |
| #define PMNORM (1<<PNORM) |
| #define PMREGISTER (1<<PREGISTER) |
| #define PMINSTR (1<<PINSTR) |
| #define PMUNIMPL (1<<PUNIMPL) |
| #define PMMOVEM (1<<PMOVEM) |
| |
| #ifndef __ASSEMBLY__ |
| |
| #include <linux/kernel.h> |
| #include <linux/sched.h> |
| |
| union fp_mant64 { |
| unsigned long long m64; |
| unsigned long m32[2]; |
| }; |
| |
| union fp_mant128 { |
| unsigned long long m64[2]; |
| unsigned long m32[4]; |
| }; |
| |
| /* internal representation of extended fp numbers */ |
| struct fp_ext { |
| unsigned char lowmant; |
| unsigned char sign; |
| unsigned short exp; |
| union fp_mant64 mant; |
| }; |
| |
| /* C representation of FPU registers */ |
| /* NOTE: if you change this, you have to change the assembler offsets |
| below and the size in <asm/fpu.h>, too */ |
| struct fp_data { |
| struct fp_ext fpreg[8]; |
| unsigned int fpcr; |
| unsigned int fpsr; |
| unsigned int fpiar; |
| unsigned short prec; |
| unsigned short rnd; |
| struct fp_ext temp[2]; |
| }; |
| |
| #if FPU_EMU_DEBUG |
| extern unsigned int fp_debugprint; |
| |
| #define dprint(bit, fmt, args...) ({ \ |
| if (fp_debugprint & (1 << (bit))) \ |
| printk(fmt, ## args); \ |
| }) |
| #else |
| #define dprint(bit, fmt, args...) |
| #endif |
| |
| #define uprint(str) ({ \ |
| static int __count = 3; \ |
| \ |
| if (__count > 0) { \ |
| printk("You just hit an unimplemented " \ |
| "fpu instruction (%s)\n", str); \ |
| printk("Please report this to ....\n"); \ |
| __count--; \ |
| } \ |
| }) |
| |
| #define FPDATA ((struct fp_data *)current->thread.fp) |
| |
| #else /* __ASSEMBLY__ */ |
| |
| #define FPDATA %a2 |
| |
| /* offsets from the base register to the floating point data in the task struct */ |
| #define FPD_FPREG (TASK_THREAD+THREAD_FPREG+0) |
| #define FPD_FPCR (TASK_THREAD+THREAD_FPREG+96) |
| #define FPD_FPSR (TASK_THREAD+THREAD_FPREG+100) |
| #define FPD_FPIAR (TASK_THREAD+THREAD_FPREG+104) |
| #define FPD_PREC (TASK_THREAD+THREAD_FPREG+108) |
| #define FPD_RND (TASK_THREAD+THREAD_FPREG+110) |
| #define FPD_TEMPFP1 (TASK_THREAD+THREAD_FPREG+112) |
| #define FPD_TEMPFP2 (TASK_THREAD+THREAD_FPREG+124) |
| #define FPD_SIZEOF (TASK_THREAD+THREAD_FPREG+136) |
| |
| /* offsets on the stack to access saved registers, |
| * these are only used during instruction decoding |
| * where we always know how deep we're on the stack. |
| */ |
| #define FPS_DO (PT_D0) |
| #define FPS_D1 (PT_D1) |
| #define FPS_D2 (PT_D2) |
| #define FPS_A0 (PT_A0) |
| #define FPS_A1 (PT_A1) |
| #define FPS_A2 (PT_A2) |
| #define FPS_SR (PT_SR) |
| #define FPS_PC (PT_PC) |
| #define FPS_EA (PT_PC+6) |
| #define FPS_PC2 (PT_PC+10) |
| |
| .macro fp_get_fp_reg |
| lea (FPD_FPREG,FPDATA,%d0.w*4),%a0 |
| lea (%a0,%d0.w*8),%a0 |
| .endm |
| |
| /* Macros used to get/put the current program counter. |
| * 020/030 use a different stack frame then 040/060, for the |
| * 040/060 the return pc points already to the next location, |
| * so this only needs to be modified for jump instructions. |
| */ |
| .macro fp_get_pc dest |
| move.l (FPS_PC+4,%sp),\dest |
| .endm |
| |
| .macro fp_put_pc src,jump=0 |
| move.l \src,(FPS_PC+4,%sp) |
| .endm |
| |
| .macro fp_get_instr_data f,s,dest,label |
| getuser \f,%sp@(FPS_PC+4)@(0),\dest,\label,%sp@(FPS_PC+4) |
| addq.l #\s,%sp@(FPS_PC+4) |
| .endm |
| |
| .macro fp_get_instr_word dest,label,addr |
| fp_get_instr_data w,2,\dest,\label,\addr |
| .endm |
| |
| .macro fp_get_instr_long dest,label,addr |
| fp_get_instr_data l,4,\dest,\label,\addr |
| .endm |
| |
| /* These macros are used to read from/write to user space |
| * on error we jump to the fixup section, load the fault |
| * address into %a0 and jump to the exit. |
| * (derived from <asm/uaccess.h>) |
| */ |
| .macro getuser size,src,dest,label,addr |
| | printf ,"[\size<%08x]",1,\addr |
| .Lu1\@: moves\size \src,\dest |
| |
| .section .fixup,"ax" |
| .even |
| .Lu2\@: move.l \addr,%a0 |
| jra \label |
| .previous |
| |
| .section __ex_table,"a" |
| .align 4 |
| .long .Lu1\@,.Lu2\@ |
| .previous |
| .endm |
| |
| .macro putuser size,src,dest,label,addr |
| | printf ,"[\size>%08x]",1,\addr |
| .Lu1\@: moves\size \src,\dest |
| .Lu2\@: |
| |
| .section .fixup,"ax" |
| .even |
| .Lu3\@: move.l \addr,%a0 |
| jra \label |
| .previous |
| |
| .section __ex_table,"a" |
| .align 4 |
| .long .Lu1\@,.Lu3\@ |
| .long .Lu2\@,.Lu3\@ |
| .previous |
| .endm |
| |
| |
| .macro movestack nr,arg1,arg2,arg3,arg4,arg5 |
| .if \nr |
| movestack (\nr-1),\arg2,\arg3,\arg4,\arg5 |
| move.l \arg1,-(%sp) |
| .endif |
| .endm |
| |
| .macro printf bit=-1,string,nr=0,arg1,arg2,arg3,arg4,arg5 |
| #ifdef FPU_EMU_DEBUG |
| .data |
| .Lpdata\@: |
| .string "\string" |
| .previous |
| |
| movem.l %d0/%d1/%a0/%a1,-(%sp) |
| .if \bit+1 |
| #if 0 |
| moveq #\bit,%d0 |
| andw #7,%d0 |
| btst %d0,fp_debugprint+((31-\bit)/8) |
| #else |
| btst #\bit,fp_debugprint+((31-\bit)/8) |
| #endif |
| jeq .Lpskip\@ |
| .endif |
| movestack \nr,\arg1,\arg2,\arg3,\arg4,\arg5 |
| pea .Lpdata\@ |
| jsr printk |
| lea ((\nr+1)*4,%sp),%sp |
| .Lpskip\@: |
| movem.l (%sp)+,%d0/%d1/%a0/%a1 |
| #endif |
| .endm |
| |
| .macro printx bit,fp |
| #ifdef FPU_EMU_DEBUG |
| movem.l %d0/%a0,-(%sp) |
| lea \fp,%a0 |
| #if 0 |
| moveq #'+',%d0 |
| tst.w (%a0) |
| jeq .Lx1\@ |
| moveq #'-',%d0 |
| .Lx1\@: printf \bit," %c",1,%d0 |
| move.l (4,%a0),%d0 |
| bclr #31,%d0 |
| jne .Lx2\@ |
| printf \bit,"0." |
| jra .Lx3\@ |
| .Lx2\@: printf \bit,"1." |
| .Lx3\@: printf \bit,"%08x%08x",2,%d0,%a0@(8) |
| move.w (2,%a0),%d0 |
| ext.l %d0 |
| printf \bit,"E%04x",1,%d0 |
| #else |
| printf \bit," %08x%08x%08x",3,%a0@,%a0@(4),%a0@(8) |
| #endif |
| movem.l (%sp)+,%d0/%a0 |
| #endif |
| .endm |
| |
| .macro debug instr,args |
| #ifdef FPU_EMU_DEBUG |
| \instr \args |
| #endif |
| .endm |
| |
| |
| #endif /* __ASSEMBLY__ */ |
| |
| #endif /* _ASM_FRV_MATH_EMU_H */ |
| |
