�     >Cordic
� by  Jan Vlietinck
� (c) AU August 1994
(
2� 0
<k=0.607252935
Fȑ 640,512
P�ASS
Z�
d&� "Calculating normals and radius"
n�
x7 � '"x,y with ABS(x) & ABS(y)< 23172=2^15/SQR(2) "'
� � x:� y
� �basic(x,y)
� � '"With CORDIC in basic"
� � "x/SQR(x*x+y*y)= ";xn
� � "y/SQR(x*x+y*y)= ";yn
� � "SQR(x*x+y*y)= ";RD
� � '"With CORDIC in arm"
� A%=x:B%=y:� norm
�# � "x/SQR(x*x+y*y)= ";!cos/2^16
�# � "y/SQR(x*x+y*y)= ";!sin/2^16
�$ � "SQR(x*x+y*y)= ";!radius/2^16
� � '"With formula in basic"
�& � "x/SQR(x*x+y*y)= ";x/�(x*x+y*y)

& � "y/SQR(x*x+y*y)= ";y/�(x*x+y*y)

" � "SQR(x*x+y*y)= ";�(x*x+y*y)

� �

"

,� �basic(x,y)

6
xn=k:yn=0

@� x<0 � x=-x:y=-y:xn=-xn

J� i=0 � 32

T
 � y>=0 �

^  s=xn-yn*2^(-i)

h  yn=yn+xn*2^(-i)

r  t=x+y*2^(-i)

|  y=y-x*2^(-i)

� �

�  s=xn+yn*2^(-i)

�  yn=yn-xn*2^(-i)

�  t=x-y*2^(-i)

�  y=y+x*2^(-i)

� �

�	 xn=s

� x=t

��

�
RD=x*k

��

�

�
� �ASS
� Q% 200
x=0:y=1:xn=2:yn=3:I=4:T=5
� PASS=0 � 2 � 2
&	P%=Q%
0
[OPT PASS
:.kd EQUD k*2^16
D.cos EQUD 0
N.sin EQUD 0
X.radius EQUD 0
b	.norm
lLDR T,kd
vMOV xn,T
�
MOV yn,#0
�CMP x,#0
�RSBMI x,x,#0
�RSBMI y,y,#0
�RSBMI xn,xn,#0
�
MUL x,T,x
�
MUL y,T,y
�MOV I,#0
�	.loop
�CMP y,#0
�SUBPL  T,xn,yn,ASR I
�ADDMI  T,xn,yn,ASR I
�ADDPL yn,yn,xn,ASR I
SUBMI yn,yn,xn,ASR I
MOV xn,T
ADDPL T,x,y,ASR I
 SUBMI T,x,y,ASR I
*SUBPL y,y,x,ASR I
4ADDMI y,y,x,ASR I
>MOV x,T
HADD I,I,#1
R
CMP I,#16
\BNE loop
fSTR x,radius
pSTR xn,cos
zSTR yn,sin
�MOV PC,R14
�]
��
��
�

00000000  0d 00 0a 11 f4 20 20 20  20 20 3e 43 6f 72 64 69  |.....     >Cordi|
00000010  63 0d 00 14 17 f4 20 62  79 20 20 4a 61 6e 20 56  |c..... by  Jan V|
00000020  6c 69 65 74 69 6e 63 6b  0d 00 1e 18 f4 20 28 63  |lietinck..... (c|
00000030  29 20 41 55 20 41 75 67  75 73 74 20 31 39 39 34  |) AU August 1994|
00000040  0d 00 28 04 0d 00 32 07  eb 20 30 0d 00 3c 11 6b  |..(...2.. 0..<.k|
00000050  3d 30 2e 36 30 37 32 35  32 39 33 35 0d 00 46 0e  |=0.607252935..F.|
00000060  c8 91 20 36 34 30 2c 35  31 32 0d 00 50 08 f2 41  |.. 640,512..P..A|
00000070  53 53 0d 00 5a 05 db 0d  00 64 26 f1 20 22 43 61  |SS..Z....d&. "Ca|
00000080  6c 63 75 6c 61 74 69 6e  67 20 6e 6f 72 6d 61 6c  |lculating normal|
00000090  73 20 61 6e 64 20 72 61  64 69 75 73 22 0d 00 6e  |s and radius"..n|
000000a0  05 f5 0d 00 78 37 20 e8  20 27 22 78 2c 79 20 77  |....x7 . '"x,y w|
000000b0  69 74 68 20 41 42 53 28  78 29 20 26 20 41 42 53  |ith ABS(x) & ABS|
000000c0  28 79 29 3c 20 32 33 31  37 32 3d 32 5e 31 35 2f  |(y)< 23172=2^15/|
000000d0  53 51 52 28 32 29 20 22  27 0d 00 82 0c 20 e8 20  |SQR(2) "'.... . |
000000e0  78 3a e8 20 79 0d 00 8c  10 20 f2 62 61 73 69 63  |x:. y.... .basic|
000000f0  28 78 2c 79 29 0d 00 96  1e 20 f1 20 27 22 57 69  |(x,y).... . '"Wi|
00000100  74 68 20 43 4f 52 44 49  43 20 69 6e 20 62 61 73  |th CORDIC in bas|
00000110  69 63 22 0d 00 a0 1c 20  f1 20 22 78 2f 53 51 52  |ic".... . "x/SQR|
00000120  28 78 2a 78 2b 79 2a 79  29 3d 20 22 3b 78 6e 0d  |(x*x+y*y)= ";xn.|
00000130  00 aa 1c 20 f1 20 22 79  2f 53 51 52 28 78 2a 78  |... . "y/SQR(x*x|
00000140  2b 79 2a 79 29 3d 20 22  3b 79 6e 0d 00 b4 1a 20  |+y*y)= ";yn.... |
00000150  f1 20 22 53 51 52 28 78  2a 78 2b 79 2a 79 29 3d  |. "SQR(x*x+y*y)=|
00000160  20 22 3b 52 44 0d 00 be  1c 20 f1 20 27 22 57 69  | ";RD.... . '"Wi|
00000170  74 68 20 43 4f 52 44 49  43 20 69 6e 20 61 72 6d  |th CORDIC in arm|
00000180  22 0d 00 c8 15 20 41 25  3d 78 3a 42 25 3d 79 3a  |".... A%=x:B%=y:|
00000190  d6 20 6e 6f 72 6d 0d 00  d2 23 20 f1 20 22 78 2f  |. norm...# . "x/|
000001a0  53 51 52 28 78 2a 78 2b  79 2a 79 29 3d 20 22 3b  |SQR(x*x+y*y)= ";|
000001b0  21 63 6f 73 2f 32 5e 31  36 0d 00 dc 23 20 f1 20  |!cos/2^16...# . |
000001c0  22 79 2f 53 51 52 28 78  2a 78 2b 79 2a 79 29 3d  |"y/SQR(x*x+y*y)=|
000001d0  20 22 3b 21 73 69 6e 2f  32 5e 31 36 0d 00 e6 24  | ";!sin/2^16...$|
000001e0  20 f1 20 22 53 51 52 28  78 2a 78 2b 79 2a 79 29  | . "SQR(x*x+y*y)|
000001f0  3d 20 22 3b 21 72 61 64  69 75 73 2f 32 5e 31 36  |= ";!radius/2^16|
00000200  0d 00 f0 1f 20 f1 20 27  22 57 69 74 68 20 66 6f  |.... . '"With fo|
00000210  72 6d 75 6c 61 20 69 6e  20 62 61 73 69 63 22 0d  |rmula in basic".|
00000220  00 fa 26 20 f1 20 22 78  2f 53 51 52 28 78 2a 78  |..& . "x/SQR(x*x|
00000230  2b 79 2a 79 29 3d 20 22  3b 78 2f b6 28 78 2a 78  |+y*y)= ";x/.(x*x|
00000240  2b 79 2a 79 29 0d 01 04  26 20 f1 20 22 79 2f 53  |+y*y)...& . "y/S|
00000250  51 52 28 78 2a 78 2b 79  2a 79 29 3d 20 22 3b 79  |QR(x*x+y*y)= ";y|
00000260  2f b6 28 78 2a 78 2b 79  2a 79 29 0d 01 0e 22 20  |/.(x*x+y*y)..." |
00000270  f1 20 22 53 51 52 28 78  2a 78 2b 79 2a 79 29 3d  |. "SQR(x*x+y*y)=|
00000280  20 22 3b b6 28 78 2a 78  2b 79 2a 79 29 0d 01 18  | ";.(x*x+y*y)...|
00000290  07 fd 20 a3 0d 01 22 04  0d 01 2c 11 dd 20 f2 62  |.. ..."...,.. .b|
000002a0  61 73 69 63 28 78 2c 79  29 0d 01 36 0d 78 6e 3d  |asic(x,y)..6.xn=|
000002b0  6b 3a 79 6e 3d 30 0d 01  40 1c e7 20 78 3c 30 20  |k:yn=0..@.. x<0 |
000002c0  8c 20 78 3d 2d 78 3a 79  3d 2d 79 3a 78 6e 3d 2d  |. x=-x:y=-y:xn=-|
000002d0  78 6e 0d 01 4a 0e e3 20  69 3d 30 20 b8 20 33 32  |xn..J.. i=0 . 32|
000002e0  0d 01 54 0d 20 e7 20 79  3e 3d 30 20 8c 0d 01 5e  |..T. . y>=0 ...^|
000002f0  14 20 20 73 3d 78 6e 2d  79 6e 2a 32 5e 28 2d 69  |.  s=xn-yn*2^(-i|
00000300  29 0d 01 68 15 20 20 79  6e 3d 79 6e 2b 78 6e 2a  |)..h.  yn=yn+xn*|
00000310  32 5e 28 2d 69 29 0d 01  72 12 20 20 74 3d 78 2b  |2^(-i)..r.  t=x+|
00000320  79 2a 32 5e 28 2d 69 29  0d 01 7c 12 20 20 79 3d  |y*2^(-i)..|.  y=|
00000330  79 2d 78 2a 32 5e 28 2d  69 29 0d 01 86 06 20 cc  |y-x*2^(-i).... .|
00000340  0d 01 90 14 20 20 73 3d  78 6e 2b 79 6e 2a 32 5e  |....  s=xn+yn*2^|
00000350  28 2d 69 29 0d 01 9a 15  20 20 79 6e 3d 79 6e 2d  |(-i)....  yn=yn-|
00000360  78 6e 2a 32 5e 28 2d 69  29 0d 01 a4 12 20 20 74  |xn*2^(-i)....  t|
00000370  3d 78 2d 79 2a 32 5e 28  2d 69 29 0d 01 ae 12 20  |=x-y*2^(-i).... |
00000380  20 79 3d 79 2b 78 2a 32  5e 28 2d 69 29 0d 01 b8  | y=y+x*2^(-i)...|
00000390  06 20 cd 0d 01 c2 09 20  78 6e 3d 73 0d 01 cc 08  |. ..... xn=s....|
000003a0  20 78 3d 74 0d 01 d6 05  ed 0d 01 e0 0a 52 44 3d  | x=t.........RD=|
000003b0  78 2a 6b 0d 01 ea 05 e1  0d 01 f4 04 0d 01 fe 0a  |x*k.............|
000003c0  dd 20 f2 41 53 53 0d 02  08 0c de 20 51 25 20 32  |. .ASS..... Q% 2|
000003d0  30 30 0d 02 12 1d 78 3d  30 3a 79 3d 31 3a 78 6e  |00....x=0:y=1:xn|
000003e0  3d 32 3a 79 6e 3d 33 3a  49 3d 34 3a 54 3d 35 0d  |=2:yn=3:I=4:T=5.|
000003f0  02 1c 14 e3 20 50 41 53  53 3d 30 20 b8 20 32 20  |.... PASS=0 . 2 |
00000400  88 20 32 0d 02 26 09 50  25 3d 51 25 0d 02 30 0d  |. 2..&.P%=Q%..0.|
00000410  5b 4f 50 54 20 50 41 53  53 0d 02 3a 13 2e 6b 64  |[OPT PASS..:..kd|
00000420  20 45 51 55 44 20 6b 2a  32 5e 31 36 0d 02 44 0f  | EQUD k*2^16..D.|
00000430  2e 63 6f 73 20 45 51 55  44 20 30 0d 02 4e 0f 2e  |.cos EQUD 0..N..|
00000440  73 69 6e 20 45 51 55 44  20 30 0d 02 58 12 2e 72  |sin EQUD 0..X..r|
00000450  61 64 69 75 73 20 45 51  55 44 20 30 0d 02 62 09  |adius EQUD 0..b.|
00000460  2e 6e 6f 72 6d 0d 02 6c  0c 4c 44 52 20 54 2c 6b  |.norm..l.LDR T,k|
00000470  64 0d 02 76 0c 4d 4f 56  20 78 6e 2c 54 0d 02 80  |d..v.MOV xn,T...|
00000480  0d 4d 4f 56 20 79 6e 2c  23 30 0d 02 8a 0c 43 4d  |.MOV yn,#0....CM|
00000490  50 20 78 2c 23 30 0d 02  94 10 52 53 42 4d 49 20  |P x,#0....RSBMI |
000004a0  78 2c 78 2c 23 30 0d 02  9e 10 52 53 42 4d 49 20  |x,x,#0....RSBMI |
000004b0  79 2c 79 2c 23 30 0d 02  a8 12 52 53 42 4d 49 20  |y,y,#0....RSBMI |
000004c0  78 6e 2c 78 6e 2c 23 30  0d 02 b2 0d 4d 55 4c 20  |xn,xn,#0....MUL |
000004d0  78 2c 54 2c 78 0d 02 bc  0d 4d 55 4c 20 79 2c 54  |x,T,x....MUL y,T|
000004e0  2c 79 0d 02 c6 0c 4d 4f  56 20 49 2c 23 30 0d 02  |,y....MOV I,#0..|
000004f0  d0 09 2e 6c 6f 6f 70 0d  02 da 0c 43 4d 50 20 79  |...loop....CMP y|
00000500  2c 23 30 0d 02 e4 18 53  55 42 50 4c 20 20 54 2c  |,#0....SUBPL  T,|
00000510  78 6e 2c 79 6e 2c 41 53  52 20 49 0d 02 ee 18 41  |xn,yn,ASR I....A|
00000520  44 44 4d 49 20 20 54 2c  78 6e 2c 79 6e 2c 41 53  |DDMI  T,xn,yn,AS|
00000530  52 20 49 0d 02 f8 18 41  44 44 50 4c 20 79 6e 2c  |R I....ADDPL yn,|
00000540  79 6e 2c 78 6e 2c 41 53  52 20 49 0d 03 02 18 53  |yn,xn,ASR I....S|
00000550  55 42 4d 49 20 79 6e 2c  79 6e 2c 78 6e 2c 41 53  |UBMI yn,yn,xn,AS|
00000560  52 20 49 0d 03 0c 0c 4d  4f 56 20 78 6e 2c 54 0d  |R I....MOV xn,T.|
00000570  03 16 15 41 44 44 50 4c  20 54 2c 78 2c 79 2c 41  |...ADDPL T,x,y,A|
00000580  53 52 20 49 0d 03 20 15  53 55 42 4d 49 20 54 2c  |SR I.. .SUBMI T,|
00000590  78 2c 79 2c 41 53 52 20  49 0d 03 2a 15 53 55 42  |x,y,ASR I..*.SUB|
000005a0  50 4c 20 79 2c 79 2c 78  2c 41 53 52 20 49 0d 03  |PL y,y,x,ASR I..|
000005b0  34 15 41 44 44 4d 49 20  79 2c 79 2c 78 2c 41 53  |4.ADDMI y,y,x,AS|
000005c0  52 20 49 0d 03 3e 0b 4d  4f 56 20 78 2c 54 0d 03  |R I..>.MOV x,T..|
000005d0  48 0e 41 44 44 20 49 2c  49 2c 23 31 0d 03 52 0d  |H.ADD I,I,#1..R.|
000005e0  43 4d 50 20 49 2c 23 31  36 0d 03 5c 0c 42 4e 45  |CMP I,#16..\.BNE|
000005f0  20 6c 6f 6f 70 0d 03 66  10 53 54 52 20 78 2c 72  | loop..f.STR x,r|
00000600  61 64 69 75 73 0d 03 70  0e 53 54 52 20 78 6e 2c  |adius..p.STR xn,|
00000610  63 6f 73 0d 03 7a 0e 53  54 52 20 79 6e 2c 73 69  |cos..z.STR yn,si|
00000620  6e 0d 03 84 0e 4d 4f 56  20 50 43 2c 52 31 34 0d  |n....MOV PC,R14.|
00000630  03 8e 05 5d 0d 03 98 05  ed 0d 03 a2 05 e1 0d ff  |...]............|
00000640