arch/m68k/fpsp040/x_unsupp.S

   1 |
   2 |       x_unsupp.sa 3.3 7/1/91
   3 |
   4 |       fpsp_unsupp --- FPSP handler for unsupported data type exception
   5 |
   6 | Trap vector #55       (See table 8-1 Mc68030 User's manual).
   7 | Invoked when the user program encounters a data format (packed) that
   8 | hardware does not support or a data type (denormalized numbers or un-
   9 | normalized numbers).
  10 | Normalizes denorms and unnorms, unpacks packed numbers then stores
  11 | them back into the machine to let the 040 finish the operation.
  12 |
  13 | Unsupp calls two routines:
  14 |       1. get_op -  gets the operand(s)
  15 |       2. res_func - restore the function back into the 040 or
  16 |                       if fmove.p fpm,<ea> then pack source (fpm)
  17 |                       and store in users memory <ea>.
  18 |
  19 |  Input: Long fsave stack frame
  20 |
  21 |
  22
  23 |               Copyright (C) Motorola, Inc. 1990
  24 |                       All Rights Reserved
  25 |
  26 |       THIS IS UNPUBLISHED PROPRIETARY SOURCE CODE OF MOTOROLA
  27 |       The copyright notice above does not evidence any
  28 |       actual or intended publication of such source code.
  29
  30 X_UNSUPP:       |idnt    2,1 | Motorola 040 Floating Point Software Package
  31
  32         |section        8
  33
  34 #include "fpsp.h"
  35
  36         |xref   get_op
  37         |xref   res_func
  38         |xref   gen_except
  39         |xref   fpsp_fmt_error
  40
  41         .global fpsp_unsupp
  42 fpsp_unsupp:
  43 |
  44         link            %a6,#-LOCAL_SIZE
  45         fsave           -(%a7)
  46         moveml          %d0-%d1/%a0-%a1,USER_DA(%a6)
  47         fmovemx %fp0-%fp3,USER_FP0(%a6)
  48         fmoveml %fpcr/%fpsr/%fpiar,USER_FPCR(%a6)
  49
  50
  51         moveb           (%a7),VER_TMP(%a6) |save version number
  52         moveb           (%a7),%d0               |test for valid version num
  53         andib           #0xf0,%d0               |test for $4x
  54         cmpib           #VER_4,%d0      |must be $4x or exit
  55         bnel            fpsp_fmt_error
  56
  57         fmovel          #0,%FPSR                |clear all user status bits
  58         fmovel          #0,%FPCR                |clear all user control bits
  59 |
  60 |       The following lines are used to ensure that the FPSR
  61 |       exception byte and condition codes are clear before proceeding,
  62 |       except in the case of fmove, which leaves the cc's intact.
  63 |
  64 unsupp_con:
  65         movel           USER_FPSR(%a6),%d1
  66         btst            #5,CMDREG1B(%a6)        |looking for fmove out
  67         bne             fmove_con
  68         andl            #0xFF00FF,%d1   |clear all but aexcs and qbyte
  69         bras            end_fix
  70 fmove_con:
  71         andl            #0x0FFF40FF,%d1 |clear all but cc's, snan bit, aexcs, and qbyte
  72 end_fix:
  73         movel           %d1,USER_FPSR(%a6)
  74
  75         st              UFLG_TMP(%a6)   |set flag for unsupp data
  76
  77         bsrl            get_op          |everything okay, go get operand(s)
  78         bsrl            res_func        |fix up stack frame so can restore it
  79         clrl            -(%a7)
  80         moveb           VER_TMP(%a6),(%a7) |move idle fmt word to top of stack
  81         bral            gen_except
  82 |
  83         |end