1 /* 1 /*
2 * Copyright (c) 2011 Broadcom Corporation 2 * Copyright (c) 2011 Broadcom Corporation
3 * 3 *
4 * Permission to use, copy, modify, and/or dis 4 * Permission to use, copy, modify, and/or distribute this software for any
5 * purpose with or without fee is hereby grant 5 * purpose with or without fee is hereby granted, provided that the above
6 * copyright notice and this permission notice 6 * copyright notice and this permission notice appear in all copies.
7 * 7 *
8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AU 8 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL 9 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SH 10 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL 11 * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA 12 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS A 13 * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
14 * CONNECTION WITH THE USE OR PERFORMANCE OF T 14 * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
15 */ 15 */
16 #include <linux/module.h> 16 #include <linux/module.h>
17 #include <linux/cordic.h> 17 #include <linux/cordic.h>
18 18
19 static const s32 arctan_table[] = { 19 static const s32 arctan_table[] = {
20 2949120, 20 2949120,
21 1740967, 21 1740967,
22 919879, 22 919879,
23 466945, 23 466945,
24 234379, 24 234379,
25 117304, 25 117304,
26 58666, 26 58666,
27 29335, 27 29335,
28 14668, 28 14668,
29 7334, 29 7334,
30 3667, 30 3667,
31 1833, 31 1833,
32 917, 32 917,
33 458, 33 458,
34 229, 34 229,
35 115, 35 115,
36 57, 36 57,
37 29 37 29
38 }; 38 };
39 39
40 /* 40 /*
41 * cordic_calc_iq() - calculates the i/q coord 41 * cordic_calc_iq() - calculates the i/q coordinate for given angle
42 * 42 *
43 * theta: angle in degrees for which i/q coord 43 * theta: angle in degrees for which i/q coordinate is to be calculated
44 * coord: function output parameter holding th 44 * coord: function output parameter holding the i/q coordinate
45 */ 45 */
46 struct cordic_iq cordic_calc_iq(s32 theta) 46 struct cordic_iq cordic_calc_iq(s32 theta)
47 { 47 {
48 struct cordic_iq coord; 48 struct cordic_iq coord;
49 s32 angle, valtmp; 49 s32 angle, valtmp;
50 unsigned iter; 50 unsigned iter;
51 int signx = 1; 51 int signx = 1;
52 int signtheta; 52 int signtheta;
53 53
54 coord.i = CORDIC_ANGLE_GEN; 54 coord.i = CORDIC_ANGLE_GEN;
55 coord.q = 0; 55 coord.q = 0;
56 angle = 0; 56 angle = 0;
57 57
58 theta = CORDIC_FIXED(theta); 58 theta = CORDIC_FIXED(theta);
59 signtheta = (theta < 0) ? -1 : 1; 59 signtheta = (theta < 0) ? -1 : 1;
60 theta = ((theta + CORDIC_FIXED(180) * 60 theta = ((theta + CORDIC_FIXED(180) * signtheta) % CORDIC_FIXED(360)) -
61 CORDIC_FIXED(180) * signtheta; 61 CORDIC_FIXED(180) * signtheta;
62 62
63 if (CORDIC_FLOAT(theta) > 90) { 63 if (CORDIC_FLOAT(theta) > 90) {
64 theta -= CORDIC_FIXED(180); 64 theta -= CORDIC_FIXED(180);
65 signx = -1; 65 signx = -1;
66 } else if (CORDIC_FLOAT(theta) < -90) 66 } else if (CORDIC_FLOAT(theta) < -90) {
67 theta += CORDIC_FIXED(180); 67 theta += CORDIC_FIXED(180);
68 signx = -1; 68 signx = -1;
69 } 69 }
70 70
71 for (iter = 0; iter < CORDIC_NUM_ITER; 71 for (iter = 0; iter < CORDIC_NUM_ITER; iter++) {
72 if (theta > angle) { 72 if (theta > angle) {
73 valtmp = coord.i - (co 73 valtmp = coord.i - (coord.q >> iter);
74 coord.q += (coord.i >> 74 coord.q += (coord.i >> iter);
75 angle += arctan_table[ 75 angle += arctan_table[iter];
76 } else { 76 } else {
77 valtmp = coord.i + (co 77 valtmp = coord.i + (coord.q >> iter);
78 coord.q -= (coord.i >> 78 coord.q -= (coord.i >> iter);
79 angle -= arctan_table[ 79 angle -= arctan_table[iter];
80 } 80 }
81 coord.i = valtmp; 81 coord.i = valtmp;
82 } 82 }
83 83
84 coord.i *= signx; 84 coord.i *= signx;
85 coord.q *= signx; 85 coord.q *= signx;
86 return coord; 86 return coord;
87 } 87 }
88 EXPORT_SYMBOL(cordic_calc_iq); 88 EXPORT_SYMBOL(cordic_calc_iq);
89 89
90 MODULE_DESCRIPTION("CORDIC algorithm"); 90 MODULE_DESCRIPTION("CORDIC algorithm");
91 MODULE_AUTHOR("Broadcom Corporation"); 91 MODULE_AUTHOR("Broadcom Corporation");
92 MODULE_LICENSE("Dual BSD/GPL"); 92 MODULE_LICENSE("Dual BSD/GPL");
93 93
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.