Blame view

kernel/linux-imx6_3.14.28/arch/m68k/fpsp040/binstr.S 4.2 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
  |
  |	binstr.sa 3.3 12/19/90
  |
  |
  |	Description: Converts a 64-bit binary integer to bcd.
  |
  |	Input: 64-bit binary integer in d2:d3, desired length (LEN) in
  |          d0, and a  pointer to start in memory for bcd characters
  |          in d0. (This pointer must point to byte 4 of the first
  |          lword of the packed decimal memory string.)
  |
  |	Output:	LEN bcd digits representing the 64-bit integer.
  |
  |	Algorithm:
  |		The 64-bit binary is assumed to have a decimal point before
  |		bit 63.  The fraction is multiplied by 10 using a mul by 2
  |		shift and a mul by 8 shift.  The bits shifted out of the
  |		msb form a decimal digit.  This process is iterated until
  |		LEN digits are formed.
  |
  |	A1. Init d7 to 1.  D7 is the byte digit counter, and if 1, the
  |		digit formed will be assumed the least significant.  This is
  |		to force the first byte formed to have a 0 in the upper 4 bits.
  |
  |	A2. Beginning of the loop:
  |		Copy the fraction in d2:d3 to d4:d5.
  |
  |	A3. Multiply the fraction in d2:d3 by 8 using bit-field
  |		extracts and shifts.  The three msbs from d2 will go into
  |		d1.
  |
  |	A4. Multiply the fraction in d4:d5 by 2 using shifts.  The msb
  |		will be collected by the carry.
  |
  |	A5. Add using the carry the 64-bit quantities in d2:d3 and d4:d5
  |		into d2:d3.  D1 will contain the bcd digit formed.
  |
  |	A6. Test d7.  If zero, the digit formed is the ms digit.  If non-
  |		zero, it is the ls digit.  Put the digit in its place in the
  |		upper word of d0.  If it is the ls digit, write the word
  |		from d0 to memory.
  |
  |	A7. Decrement d6 (LEN counter) and repeat the loop until zero.
  |
  |	Implementation Notes:
  |
  |	The registers are used as follows:
  |
  |		d0: LEN counter
  |		d1: temp used to form the digit
  |		d2: upper 32-bits of fraction for mul by 8
  |		d3: lower 32-bits of fraction for mul by 8
  |		d4: upper 32-bits of fraction for mul by 2
  |		d5: lower 32-bits of fraction for mul by 2
  |		d6: temp for bit-field extracts
  |		d7: byte digit formation word;digit count {0,1}
  |		a0: pointer into memory for packed bcd string formation
  |
  
  |		Copyright (C) Motorola, Inc. 1990
  |			All Rights Reserved
  |
  |       For details on the license for this file, please see the
  |       file, README, in this same directory.
  
  |BINSTR    idnt    2,1 | Motorola 040 Floating Point Software Package
  
  	|section	8
  
  #include "fpsp.h"
  
  	.global	binstr
  binstr:
  	moveml	%d0-%d7,-(%a7)
  |
  | A1: Init d7
  |
  	moveql	#1,%d7			|init d7 for second digit
  	subql	#1,%d0			|for dbf d0 would have LEN+1 passes
  |
  | A2. Copy d2:d3 to d4:d5.  Start loop.
  |
  loop:
  	movel	%d2,%d4			|copy the fraction before muls
  	movel	%d3,%d5			|to d4:d5
  |
  | A3. Multiply d2:d3 by 8; extract msbs into d1.
  |
  	bfextu	%d2{#0:#3},%d1		|copy 3 msbs of d2 into d1
  	asll	#3,%d2			|shift d2 left by 3 places
  	bfextu	%d3{#0:#3},%d6		|copy 3 msbs of d3 into d6
  	asll	#3,%d3			|shift d3 left by 3 places
  	orl	%d6,%d2			|or in msbs from d3 into d2
  |
  | A4. Multiply d4:d5 by 2; add carry out to d1.
  |
  	asll	#1,%d5			|mul d5 by 2
  	roxll	#1,%d4			|mul d4 by 2
  	swap	%d6			|put 0 in d6 lower word
  	addxw	%d6,%d1			|add in extend from mul by 2
  |
  | A5. Add mul by 8 to mul by 2.  D1 contains the digit formed.
  |
  	addl	%d5,%d3			|add lower 32 bits
  	nop				|ERRATA ; FIX #13 (Rev. 1.2 6/6/90)
  	addxl	%d4,%d2			|add with extend upper 32 bits
  	nop				|ERRATA ; FIX #13 (Rev. 1.2 6/6/90)
  	addxw	%d6,%d1			|add in extend from add to d1
  	swap	%d6			|with d6 = 0; put 0 in upper word
  |
  | A6. Test d7 and branch.
  |
  	tstw	%d7			|if zero, store digit & to loop
  	beqs	first_d			|if non-zero, form byte & write
  sec_d:
  	swap	%d7			|bring first digit to word d7b
  	aslw	#4,%d7			|first digit in upper 4 bits d7b
  	addw	%d1,%d7			|add in ls digit to d7b
  	moveb	%d7,(%a0)+		|store d7b byte in memory
  	swap	%d7			|put LEN counter in word d7a
  	clrw	%d7			|set d7a to signal no digits done
  	dbf	%d0,loop		|do loop some more!
  	bras	end_bstr		|finished, so exit
  first_d:
  	swap	%d7			|put digit word in d7b
  	movew	%d1,%d7			|put new digit in d7b
  	swap	%d7			|put LEN counter in word d7a
  	addqw	#1,%d7			|set d7a to signal first digit done
  	dbf	%d0,loop		|do loop some more!
  	swap	%d7			|put last digit in string
  	lslw	#4,%d7			|move it to upper 4 bits
  	moveb	%d7,(%a0)+		|store it in memory string
  |
  | Clean up and return with result in fp0.
  |
  end_bstr:
  	moveml	(%a7)+,%d0-%d7
  	rts
  	|end