arch/m68k/include/asm/math-emu.h

   1 #ifndef _ASM_M68K_SETUP_H
   2 #define _ASM_M68K_SETUP_H
   3
   4 #include <asm/setup.h>
   5 #include <linux/linkage.h>
   6
   7 /* Status Register bits */
   8
   9 /* accrued exception bits */
  10 #define FPSR_AEXC_INEX  3
  11 #define FPSR_AEXC_DZ    4
  12 #define FPSR_AEXC_UNFL  5
  13 #define FPSR_AEXC_OVFL  6
  14 #define FPSR_AEXC_IOP   7
  15
  16 /* exception status bits */
  17 #define FPSR_EXC_INEX1  8
  18 #define FPSR_EXC_INEX2  9
  19 #define FPSR_EXC_DZ     10
  20 #define FPSR_EXC_UNFL   11
  21 #define FPSR_EXC_OVFL   12
  22 #define FPSR_EXC_OPERR  13
  23 #define FPSR_EXC_SNAN   14
  24 #define FPSR_EXC_BSUN   15
  25
  26 /* quotient byte, assumes big-endian, of course */
  27 #define FPSR_QUOTIENT(fpsr) (*((signed char *) &(fpsr) + 1))
  28
  29 /* condition code bits */
  30 #define FPSR_CC_NAN     24
  31 #define FPSR_CC_INF     25
  32 #define FPSR_CC_Z       26
  33 #define FPSR_CC_NEG     27
  34
  35
  36 /* Control register bits */
  37
  38 /* rounding mode */
  39 #define FPCR_ROUND_RN   0               /* round to nearest/even */
  40 #define FPCR_ROUND_RZ   1               /* round to zero */
  41 #define FPCR_ROUND_RM   2               /* minus infinity */
  42 #define FPCR_ROUND_RP   3               /* plus infinity */
  43
  44 /* rounding precision */
  45 #define FPCR_PRECISION_X        0       /* long double */
  46 #define FPCR_PRECISION_S        1       /* double */
  47 #define FPCR_PRECISION_D        2       /* float */
  48
  49
  50 /* Flags to select the debugging output */
  51 #define PDECODE         0
  52 #define PEXECUTE        1
  53 #define PCONV           2
  54 #define PNORM           3
  55 #define PREGISTER       4
  56 #define PINSTR          5
  57 #define PUNIMPL         6
  58 #define PMOVEM          7
  59
  60 #define PMDECODE        (1<<PDECODE)
  61 #define PMEXECUTE       (1<<PEXECUTE)
  62 #define PMCONV          (1<<PCONV)
  63 #define PMNORM          (1<<PNORM)
  64 #define PMREGISTER      (1<<PREGISTER)
  65 #define PMINSTR         (1<<PINSTR)
  66 #define PMUNIMPL        (1<<PUNIMPL)
  67 #define PMMOVEM         (1<<PMOVEM)
  68
  69 #ifndef __ASSEMBLY__
  70
  71 #include <linux/kernel.h>
  72 #include <linux/sched.h>
  73
  74 union fp_mant64 {
  75         unsigned long long m64;
  76         unsigned long m32[2];
  77 };
  78
  79 union fp_mant128 {
  80         unsigned long long m64[2];
  81         unsigned long m32[4];
  82 };
  83
  84 /* internal representation of extended fp numbers */
  85 struct fp_ext {
  86         unsigned char lowmant;
  87         unsigned char sign;
  88         unsigned short exp;
  89         union fp_mant64 mant;
  90 };
  91
  92 /* C representation of FPU registers */
  93 /* NOTE: if you change this, you have to change the assembler offsets
  94    below and the size in <asm/fpu.h>, too */
  95 struct fp_data {
  96         struct fp_ext fpreg[8];
  97         unsigned int fpcr;
  98         unsigned int fpsr;
  99         unsigned int fpiar;
 100         unsigned short prec;
 101         unsigned short rnd;
 102         struct fp_ext temp[2];
 103 };
 104
 105 #ifdef FPU_EMU_DEBUG
 106 extern unsigned int fp_debugprint;
 107
 108 #define dprint(bit, fmt, args...) ({                    \
 109         if (fp_debugprint & (1 << (bit)))               \
 110                 printk(fmt, ## args);                   \
 111 })
 112 #else
 113 #define dprint(bit, fmt, args...)
 114 #endif
 115
 116 #define uprint(str) ({                                  \
 117         static int __count = 3;                         \
 118                                                         \
 119         if (__count > 0) {                              \
 120                 printk("You just hit an unimplemented " \
 121                        "fpu instruction (%s)\n", str);  \
 122                 printk("Please report this to ....\n"); \
 123                 __count--;                              \
 124         }                                               \
 125 })
 126
 127 #define FPDATA          ((struct fp_data *)current->thread.fp)
 128
 129 #else   /* __ASSEMBLY__ */
 130
 131 #define FPDATA          %a2
 132
 133 /* offsets from the base register to the floating point data in the task struct */
 134 #define FPD_FPREG       (TASK_THREAD+THREAD_FPREG+0)
 135 #define FPD_FPCR        (TASK_THREAD+THREAD_FPREG+96)
 136 #define FPD_FPSR        (TASK_THREAD+THREAD_FPREG+100)
 137 #define FPD_FPIAR       (TASK_THREAD+THREAD_FPREG+104)
 138 #define FPD_PREC        (TASK_THREAD+THREAD_FPREG+108)
 139 #define FPD_RND         (TASK_THREAD+THREAD_FPREG+110)
 140 #define FPD_TEMPFP1     (TASK_THREAD+THREAD_FPREG+112)
 141 #define FPD_TEMPFP2     (TASK_THREAD+THREAD_FPREG+124)
 142 #define FPD_SIZEOF      (TASK_THREAD+THREAD_FPREG+136)
 143
 144 /* offsets on the stack to access saved registers,
 145  * these are only used during instruction decoding
 146  * where we always know how deep we're on the stack.
 147  */
 148 #define FPS_DO          (PT_OFF_D0)
 149 #define FPS_D1          (PT_OFF_D1)
 150 #define FPS_D2          (PT_OFF_D2)
 151 #define FPS_A0          (PT_OFF_A0)
 152 #define FPS_A1          (PT_OFF_A1)
 153 #define FPS_A2          (PT_OFF_A2)
 154 #define FPS_SR          (PT_OFF_SR)
 155 #define FPS_PC          (PT_OFF_PC)
 156 #define FPS_EA          (PT_OFF_PC+6)
 157 #define FPS_PC2         (PT_OFF_PC+10)
 158
 159 .macro  fp_get_fp_reg
 160         lea     (FPD_FPREG,FPDATA,%d0.w*4),%a0
 161         lea     (%a0,%d0.w*8),%a0
 162 .endm
 163
 164 /* Macros used to get/put the current program counter.
 165  * 020/030 use a different stack frame then 040/060, for the
 166  * 040/060 the return pc points already to the next location,
 167  * so this only needs to be modified for jump instructions.
 168  */
 169 .macro  fp_get_pc dest
 170         move.l  (FPS_PC+4,%sp),\dest
 171 .endm
 172
 173 .macro  fp_put_pc src,jump=0
 174         move.l  \src,(FPS_PC+4,%sp)
 175 .endm
 176
 177 .macro  fp_get_instr_data       f,s,dest,label
 178         getuser \f,%sp@(FPS_PC+4)@(0),\dest,\label,%sp@(FPS_PC+4)
 179         addq.l  #\s,%sp@(FPS_PC+4)
 180 .endm
 181
 182 .macro  fp_get_instr_word       dest,label,addr
 183         fp_get_instr_data       w,2,\dest,\label,\addr
 184 .endm
 185
 186 .macro  fp_get_instr_long       dest,label,addr
 187         fp_get_instr_data       l,4,\dest,\label,\addr
 188 .endm
 189
 190 /* These macros are used to read from/write to user space
 191  * on error we jump to the fixup section, load the fault
 192  * address into %a0 and jump to the exit.
 193  * (derived from <asm/uaccess.h>)
 194  */
 195 .macro  getuser size,src,dest,label,addr
 196 |       printf  ,"[\size<%08x]",1,\addr
 197 .Lu1\@: moves\size      \src,\dest
 198
 199         .section .fixup,"ax"
 200         .even
 201 .Lu2\@: move.l  \addr,%a0
 202         jra     \label
 203         .previous
 204
 205         .section __ex_table,"a"
 206         .align  4
 207         .long   .Lu1\@,.Lu2\@
 208         .previous
 209 .endm
 210
 211 .macro  putuser size,src,dest,label,addr
 212 |       printf  ,"[\size>%08x]",1,\addr
 213 .Lu1\@: moves\size      \src,\dest
 214 .Lu2\@:
 215
 216         .section .fixup,"ax"
 217         .even
 218 .Lu3\@: move.l  \addr,%a0
 219         jra     \label
 220         .previous
 221
 222         .section __ex_table,"a"
 223         .align  4
 224         .long   .Lu1\@,.Lu3\@
 225         .long   .Lu2\@,.Lu3\@
 226         .previous
 227 .endm
 228
 229 /* work around binutils idiocy */
 230 old_gas=-1
 231 .irp    gas_ident.x .x
 232 old_gas=old_gas+1
 233 .endr
 234 .if !old_gas
 235 .irp    m b,w,l
 236 .macro  getuser.\m src,dest,label,addr
 237         getuser .\m,\src,\dest,\label,\addr
 238 .endm
 239 .macro  putuser.\m src,dest,label,addr
 240         putuser .\m,\src,\dest,\label,\addr
 241 .endm
 242 .endr
 243 .endif
 244
 245 .macro  movestack       nr,arg1,arg2,arg3,arg4,arg5
 246         .if     \nr
 247         movestack       (\nr-1),\arg2,\arg3,\arg4,\arg5
 248         move.l  \arg1,-(%sp)
 249         .endif
 250 .endm
 251
 252 .macro  printf  bit=-1,string,nr=0,arg1,arg2,arg3,arg4,arg5
 253 #ifdef FPU_EMU_DEBUG
 254         .data
 255 .Lpdata\@:
 256         .string "\string"
 257         .previous
 258
 259         movem.l %d0/%d1/%a0/%a1,-(%sp)
 260         .if     \bit+1
 261 #if 0
 262         moveq   #\bit,%d0
 263         andw    #7,%d0
 264         btst    %d0,fp_debugprint+((31-\bit)/8)
 265 #else
 266         btst    #\bit,fp_debugprint+((31-\bit)/8)
 267 #endif
 268         jeq     .Lpskip\@
 269         .endif
 270         movestack       \nr,\arg1,\arg2,\arg3,\arg4,\arg5
 271         pea     .Lpdata\@
 272         jsr     printk
 273         lea     ((\nr+1)*4,%sp),%sp
 274 .Lpskip\@:
 275         movem.l (%sp)+,%d0/%d1/%a0/%a1
 276 #endif
 277 .endm
 278
 279 .macro  printx  bit,fp
 280 #ifdef FPU_EMU_DEBUG
 281         movem.l %d0/%a0,-(%sp)
 282         lea     \fp,%a0
 283 #if 0
 284         moveq   #'+',%d0
 285         tst.w   (%a0)
 286         jeq     .Lx1\@
 287         moveq   #'-',%d0
 288 .Lx1\@: printf  \bit," %c",1,%d0
 289         move.l  (4,%a0),%d0
 290         bclr    #31,%d0
 291         jne     .Lx2\@
 292         printf  \bit,"0."
 293         jra     .Lx3\@
 294 .Lx2\@: printf  \bit,"1."
 295 .Lx3\@: printf  \bit,"%08x%08x",2,%d0,%a0@(8)
 296         move.w  (2,%a0),%d0
 297         ext.l   %d0
 298         printf  \bit,"E%04x",1,%d0
 299 #else
 300         printf  \bit," %08x%08x%08x",3,%a0@,%a0@(4),%a0@(8)
 301 #endif
 302         movem.l (%sp)+,%d0/%a0
 303 #endif
 304 .endm
 305
 306 .macro  debug   instr,args
 307 #ifdef FPU_EMU_DEBUG
 308         \instr  \args
 309 #endif
 310 .endm
 311
 312
 313 #endif  /* __ASSEMBLY__ */
 314
 315 #endif  /* _ASM_M68K_SETUP_H */