[4f508e6] | 1 | | ------------------------------------------------------------------------------
|
---|
| 2 | | tofpu.s -- convert between millisecond time interval and FPU increment formats
|
---|
| 3 | | Version 9 -- 1987-12-21 -- D.N. Lynx Crowe
|
---|
| 4 |
|
---|
| 5 | | unsigned short
|
---|
| 6 | | tofpu(time)
|
---|
| 7 | | unsigned short time;
|
---|
| 8 |
|
---|
| 9 | | Converts 'time' in milliseconds to FPU format.
|
---|
| 10 |
|
---|
| 11 | | unsigned short
|
---|
| 12 | | fromfpu(fputime)
|
---|
| 13 | | unsigned short fputime;
|
---|
| 14 |
|
---|
| 15 | | Converts 'fputime' from FPU format to milliseconds.
|
---|
| 16 | | ------------------------------------------------------------------------------
|
---|
[f40a309] | 17 | .text
|
---|
[4f508e6] | 18 |
|
---|
[8325447] | 19 | .xdef tofpu
|
---|
| 20 | .xdef fromfpu
|
---|
[4f508e6] | 21 |
|
---|
| 22 | TIME = 8 | WORD - time argument (either format)
|
---|
| 23 |
|
---|
| 24 | TCYCL = 0x3B000000 | LONG - scaled FPU cycle time (.4608)
|
---|
| 25 |
|
---|
[f40a309] | 26 | .page
|
---|
[8325447] | 27 | tofpu: link a6,#0 | link stack frames
|
---|
[4f508e6] | 28 | move.w TIME(a6),d1 | get time interval
|
---|
| 29 | beq notime | jump if zero time
|
---|
| 30 |
|
---|
| 31 | clr.w d2 | clear shift count
|
---|
| 32 |
|
---|
| 33 | sloop: btst #15,d1 | see if MSB is set yet
|
---|
| 34 | bne gotexp | jump if so
|
---|
| 35 |
|
---|
| 36 | lsl.w #1,d1 | shift time left a bit
|
---|
| 37 | addq.w #1,d2 | increment the shift count
|
---|
| 38 | cmpi.w #15,d2 | see if we've hit the maximum
|
---|
| 39 | bne sloop | try again if not
|
---|
| 40 |
|
---|
| 41 | gotexp: move.l #TCYCL,d0 | divide FPU cycle time by shifted value
|
---|
| 42 | divu d1,d0 | ...
|
---|
| 43 | andi.w #0xFFF0,d0 | mask result
|
---|
| 44 | or.w d2,d0 | set the exponent
|
---|
| 45 |
|
---|
| 46 | finis: unlk a6 | unlink stack frames
|
---|
| 47 | rts | return to caller
|
---|
| 48 |
|
---|
| 49 | notime: clr.w d0 | zero time is zero ...
|
---|
| 50 | bra finis | return value for zero time
|
---|
| 51 |
|
---|
[f40a309] | 52 | .page
|
---|
[8325447] | 53 | fromfpu: link a6,#0 | link stack frames
|
---|
[4f508e6] | 54 | move.w TIME(a6),d1 | get FPU formatted time
|
---|
| 55 | beq zerotime | done if it's zero
|
---|
| 56 |
|
---|
| 57 | move.w d1,d2 | extract shift count
|
---|
| 58 | andi.w #0x000F,d2 | ...
|
---|
| 59 | andi.w #0xFFF0,d1 | extract mantissa
|
---|
| 60 | beq zerotime | ... just in case it's zero (an error)
|
---|
| 61 |
|
---|
| 62 | move.l #TCYCL,d0 | get FPU cycle time
|
---|
| 63 | divu d1,d0 | divide by mantissa
|
---|
| 64 | bvc divok | jump if divide ok
|
---|
| 65 |
|
---|
| 66 | move.w #0xFFFF,d0 | jam maximum value for overflow
|
---|
| 67 |
|
---|
| 68 | divok: lsr.w d2,d0 | shift result into position
|
---|
| 69 |
|
---|
| 70 | byebye: unlk a6 | unlink stack frames
|
---|
| 71 | rts | return to caller
|
---|
| 72 |
|
---|
| 73 | zerotime: clr.l d0 | return a zero result
|
---|
| 74 | bra byebye | ...
|
---|
| 75 |
|
---|
[f40a309] | 76 | .end
|
---|