include/asm-frv/math-emu.h

   1 #ifndef _ASM_MATH_EMU_H
   2 #define _ASM_MATH_EMU_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 #if 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_D0)
 149 #define FPS_D1          (PT_D1)
 150 #define FPS_D2          (PT_D2)
 151 #define FPS_A0          (PT_A0)
 152 #define FPS_A1          (PT_A1)
 153 #define FPS_A2          (PT_A2)
 154 #define FPS_SR          (PT_SR)
 155 #define FPS_PC          (PT_PC)
 156 #define FPS_EA          (PT_PC+6)
 157 #define FPS_PC2         (PT_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
 230 .macro  movestack       nr,arg1,arg2,arg3,arg4,arg5
 231         .if     \nr
 232         movestack       (\nr-1),\arg2,\arg3,\arg4,\arg5
 233         move.l  \arg1,-(%sp)
 234         .endif
 235 .endm
 236
 237 .macro  printf  bit=-1,string,nr=0,arg1,arg2,arg3,arg4,arg5
 238 #ifdef FPU_EMU_DEBUG
 239         .data
 240 .Lpdata\@:
 241         .string "\string"
 242         .previous
 243
 244         movem.l %d0/%d1/%a0/%a1,-(%sp)
 245         .if     \bit+1
 246 #if 0
 247         moveq   #\bit,%d0
 248         andw    #7,%d0
 249         btst    %d0,fp_debugprint+((31-\bit)/8)
 250 #else
 251         btst    #\bit,fp_debugprint+((31-\bit)/8)
 252 #endif
 253         jeq     .Lpskip\@
 254         .endif
 255         movestack       \nr,\arg1,\arg2,\arg3,\arg4,\arg5
 256         pea     .Lpdata\@
 257         jsr     printk
 258         lea     ((\nr+1)*4,%sp),%sp
 259 .Lpskip\@:
 260         movem.l (%sp)+,%d0/%d1/%a0/%a1
 261 #endif
 262 .endm
 263
 264 .macro  printx  bit,fp
 265 #ifdef FPU_EMU_DEBUG
 266         movem.l %d0/%a0,-(%sp)
 267         lea     \fp,%a0
 268 #if 0
 269         moveq   #'+',%d0
 270         tst.w   (%a0)
 271         jeq     .Lx1\@
 272         moveq   #'-',%d0
 273 .Lx1\@: printf  \bit," %c",1,%d0
 274         move.l  (4,%a0),%d0
 275         bclr    #31,%d0
 276         jne     .Lx2\@
 277         printf  \bit,"0."
 278         jra     .Lx3\@
 279 .Lx2\@: printf  \bit,"1."
 280 .Lx3\@: printf  \bit,"%08x%08x",2,%d0,%a0@(8)
 281         move.w  (2,%a0),%d0
 282         ext.l   %d0
 283         printf  \bit,"E%04x",1,%d0
 284 #else
 285         printf  \bit," %08x%08x%08x",3,%a0@,%a0@(4),%a0@(8)
 286 #endif
 287         movem.l (%sp)+,%d0/%a0
 288 #endif
 289 .endm
 290
 291 .macro  debug   instr,args
 292 #ifdef FPU_EMU_DEBUG
 293         \instr  \args
 294 #endif
 295 .endm
 296
 297
 298 #endif  /* __ASSEMBLY__ */
 299
 300 #endif  /* _ASM_FRV_MATH_EMU_H */
 301