[PATCH] sky2: save/restore base hardware irq during suspend/resume
[linux-2.6] / arch / m68k / fpsp040 / smovecr.S
1 |
2 |       smovecr.sa 3.1 12/10/90
3 |
4 |       The entry point sMOVECR returns the constant at the
5 |       offset given in the instruction field.
6 |
7 |       Input: An offset in the instruction word.
8 |
9 |       Output: The constant rounded to the user's rounding
10 |               mode unchecked for overflow.
11 |
12 |       Modified: fp0.
13 |
14 |
15 |               Copyright (C) Motorola, Inc. 1990
16 |                       All Rights Reserved
17 |
18 |       For details on the license for this file, please see the
19 |       file, README, in this same directory.
20
21 |SMOVECR        idnt    2,1 | Motorola 040 Floating Point Software Package
22
23         |section 8
24
25 #include "fpsp.h"
26
27         |xref   nrm_set
28         |xref   round
29         |xref   PIRN
30         |xref   PIRZRM
31         |xref   PIRP
32         |xref   SMALRN
33         |xref   SMALRZRM
34         |xref   SMALRP
35         |xref   BIGRN
36         |xref   BIGRZRM
37         |xref   BIGRP
38
39 FZERO:  .long   00000000
40 |
41 |       FMOVECR
42 |
43         .global smovcr
44 smovcr:
45         bfextu  CMDREG1B(%a6){#9:#7},%d0 |get offset
46         bfextu  USER_FPCR(%a6){#26:#2},%d1 |get rmode
47 |
48 | check range of offset
49 |
50         tstb    %d0             |if zero, offset is to pi
51         beqs    PI_TBL          |it is pi
52         cmpib   #0x0a,%d0               |check range $01 - $0a
53         bles    Z_VAL           |if in this range, return zero
54         cmpib   #0x0e,%d0               |check range $0b - $0e
55         bles    SM_TBL          |valid constants in this range
56         cmpib   #0x2f,%d0               |check range $10 - $2f
57         bles    Z_VAL           |if in this range, return zero
58         cmpib   #0x3f,%d0               |check range $30 - $3f
59         ble     BG_TBL          |valid constants in this range
60 Z_VAL:
61         fmoves  FZERO,%fp0
62         rts
63 PI_TBL:
64         tstb    %d1             |offset is zero, check for rmode
65         beqs    PI_RN           |if zero, rn mode
66         cmpib   #0x3,%d1                |check for rp
67         beqs    PI_RP           |if 3, rp mode
68 PI_RZRM:
69         leal    PIRZRM,%a0      |rmode is rz or rm, load PIRZRM in a0
70         bra     set_finx
71 PI_RN:
72         leal    PIRN,%a0                |rmode is rn, load PIRN in a0
73         bra     set_finx
74 PI_RP:
75         leal    PIRP,%a0                |rmode is rp, load PIRP in a0
76         bra     set_finx
77 SM_TBL:
78         subil   #0xb,%d0                |make offset in 0 - 4 range
79         tstb    %d1             |check for rmode
80         beqs    SM_RN           |if zero, rn mode
81         cmpib   #0x3,%d1                |check for rp
82         beqs    SM_RP           |if 3, rp mode
83 SM_RZRM:
84         leal    SMALRZRM,%a0    |rmode is rz or rm, load SMRZRM in a0
85         cmpib   #0x2,%d0                |check if result is inex
86         ble     set_finx        |if 0 - 2, it is inexact
87         bra     no_finx         |if 3, it is exact
88 SM_RN:
89         leal    SMALRN,%a0      |rmode is rn, load SMRN in a0
90         cmpib   #0x2,%d0                |check if result is inex
91         ble     set_finx        |if 0 - 2, it is inexact
92         bra     no_finx         |if 3, it is exact
93 SM_RP:
94         leal    SMALRP,%a0      |rmode is rp, load SMRP in a0
95         cmpib   #0x2,%d0                |check if result is inex
96         ble     set_finx        |if 0 - 2, it is inexact
97         bra     no_finx         |if 3, it is exact
98 BG_TBL:
99         subil   #0x30,%d0               |make offset in 0 - f range
100         tstb    %d1             |check for rmode
101         beqs    BG_RN           |if zero, rn mode
102         cmpib   #0x3,%d1                |check for rp
103         beqs    BG_RP           |if 3, rp mode
104 BG_RZRM:
105         leal    BIGRZRM,%a0     |rmode is rz or rm, load BGRZRM in a0
106         cmpib   #0x1,%d0                |check if result is inex
107         ble     set_finx        |if 0 - 1, it is inexact
108         cmpib   #0x7,%d0                |second check
109         ble     no_finx         |if 0 - 7, it is exact
110         bra     set_finx        |if 8 - f, it is inexact
111 BG_RN:
112         leal    BIGRN,%a0       |rmode is rn, load BGRN in a0
113         cmpib   #0x1,%d0                |check if result is inex
114         ble     set_finx        |if 0 - 1, it is inexact
115         cmpib   #0x7,%d0                |second check
116         ble     no_finx         |if 0 - 7, it is exact
117         bra     set_finx        |if 8 - f, it is inexact
118 BG_RP:
119         leal    BIGRP,%a0       |rmode is rp, load SMRP in a0
120         cmpib   #0x1,%d0                |check if result is inex
121         ble     set_finx        |if 0 - 1, it is inexact
122         cmpib   #0x7,%d0                |second check
123         ble     no_finx         |if 0 - 7, it is exact
124 |       bra     set_finx        ;if 8 - f, it is inexact
125 set_finx:
126         orl     #inx2a_mask,USER_FPSR(%a6) |set inex2/ainex
127 no_finx:
128         mulul   #12,%d0                 |use offset to point into tables
129         movel   %d1,L_SCR1(%a6)         |load mode for round call
130         bfextu  USER_FPCR(%a6){#24:#2},%d1      |get precision
131         tstl    %d1                     |check if extended precision
132 |
133 | Precision is extended
134 |
135         bnes    not_ext                 |if extended, do not call round
136         fmovemx (%a0,%d0),%fp0-%fp0             |return result in fp0
137         rts
138 |
139 | Precision is single or double
140 |
141 not_ext:
142         swap    %d1                     |rnd prec in upper word of d1
143         addl    L_SCR1(%a6),%d1         |merge rmode in low word of d1
144         movel   (%a0,%d0),FP_SCR1(%a6)  |load first word to temp storage
145         movel   4(%a0,%d0),FP_SCR1+4(%a6)       |load second word
146         movel   8(%a0,%d0),FP_SCR1+8(%a6)       |load third word
147         clrl    %d0                     |clear g,r,s
148         lea     FP_SCR1(%a6),%a0
149         btstb   #sign_bit,LOCAL_EX(%a0)
150         sne     LOCAL_SGN(%a0)          |convert to internal ext. format
151
152         bsr     round                   |go round the mantissa
153
154         bfclr   LOCAL_SGN(%a0){#0:#8}   |convert back to IEEE ext format
155         beqs    fin_fcr
156         bsetb   #sign_bit,LOCAL_EX(%a0)
157 fin_fcr:
158         fmovemx (%a0),%fp0-%fp0
159         rts
160
161         |end