forked from thesofproject/sof
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathsquare_root.c
More file actions
162 lines (152 loc) · 9.28 KB
/
square_root.c
File metadata and controls
162 lines (152 loc) · 9.28 KB
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
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
// SPDX-License-Identifier: BSD-3-Clause
//
// Copyright(c) 2021 Intel Corporation. All rights reserved.
//
// Author: Shriram Shastry <malladi.sastry@linux.intel.com>
#include <stdio.h>
#include <stdint.h>
#include <stdarg.h>
#include <stddef.h>
#include <setjmp.h>
#include <math.h>
#include <cmocka.h>
#include <sof/math/sqrt.h>
#include <sof/audio/format.h>
#include <rtos/string.h>
#include <sof/common.h>
/* 'Error[max] = 0.0003000860000000,THD(-dBc) = -87.1210823527511309' */
#define CMP_TOLERANCE 0.0001689942
static const double sqrt_ref_table[] = {
0.0000000000000000, 0.2529127196287289, 0.3580137261684250, 0.4383362543470480,
0.5060667106469264, 0.5657458434447398, 0.6199010757774179, 0.6695089151758922,
0.7156864056624241, 0.7590598625931949, 0.8002380017063674, 0.8392530626247365,
0.8765332548597343, 0.9124250825410271, 0.9468285879714448, 0.9800251112854200,
1.0121334212938529, 1.0433710015497843, 1.0735864616438677, 1.1029744939820685,
1.1317074351394887, 1.1596234572049671, 1.1868830634270588, 1.2135304899342250,
1.2397036881347898, 1.2652391387105444, 1.2902693214499832, 1.3148230929007141,
1.3390178303517843, 1.3626935069009465, 1.3859648038460428, 1.4089384024417106,
1.4314580907679415, 1.4536289448738284, 1.4754666899408471, 1.4970674458754356,
1.5182805344369004, 1.5392012945030940, 1.5598414883410430, 1.5802893574042065,
1.6003997303408295, 1.6202605162827983, 1.6399552204252408, 1.6593426315110451,
1.6785061252494731, 1.6974532854396907, 1.7162624043615824, 1.7347972458979175,
1.7531361407845656, 1.7712851751976586, 1.7893183496097054, 1.8071040368501201,
1.8247163735084968, 1.8422265952170487, 1.8595062978852748, 1.8766268983537990,
1.8935927121149891, 1.9104717594746068, 1.9271396388170734, 1.9436645881555799,
1.9601125007572908, 1.9763617734046062, 1.9924785326635266, 2.0084659685628234,
2.0243874459327196, 2.0401248429936829, 2.0557417684986605, 2.0712409474756917,
2.0866835042418388, 2.1019545405705138, 2.1171154277400652, 2.1322257663648099,
2.1471729232877355, 2.1620167451363552, 2.1767593459084997, 2.1914584719713490,
2.2060043241401410, 2.2204548907543695, 2.2348120201987909, 2.2491317769308226,
2.2633070038662453, 2.2773940013752560, 2.2914476694602910, 2.3053627188850347,
2.3191942802134968, 2.3329438383992445, 2.3466648541067809, 2.3602543890966499,
2.3737661268541177, 2.3872013883939496, 2.4006123079591588, 2.4138981537908761,
2.4271112748749282, 2.4403028756693299, 2.4533737931163282, 2.4663754402969551,
2.4793089069839604, 2.4922242356226696, 2.5050242482608827, 2.5177591878742098,
2.5304782774210888, 2.5430857547967194, 2.5556310375326090, 2.5681150370943278,
2.5805859466650203, 2.5929498012639969, 2.6052549809231724, 2.6175023131556161,
2.6297390257875399, 2.6418728560436060, 2.6539512111660981, 2.6660206330081166,
2.6779900782816579, 2.6899062628881700, 2.7017698915479462, 2.7136266381449752,
2.7253870138018930, 2.7370968595849874, 2.7487568212739375, 2.7604117531402812,
2.7719736453698474, 2.7834875128828940, 2.7949976241045360, 2.8064170328908711,
2.8177901636300033, 2.8291175744390689, 2.8404427884354582, 2.8516802201728368,
2.8628735427669523, 2.8740232715872360, 2.8851722218959477, 2.8962361080806240,
2.9072578897476569, 2.9182798738083706, 2.9292187124939990, 2.9401168530136688,
2.9509747462702896, 2.9618340496219568, 2.9726126187665289, 2.9833522462156559,
2.9940941216626773, 3.0047569707257522, 3.0153821145710538, 3.0259699503836783,
3.0365610688738007, 3.0470753139280951, 3.0575534030495688, 3.0679957066870220,
3.0784422425351754, 3.0888139284157279, 3.0991509043809078, 3.1094927741514371,
3.1197612338526808, 3.1299960063872287, 3.1401974211424988, 3.1504045499149789,
3.1605400917999757, 3.1706432337342845, 3.1807142844611178, 3.1907918051402224,
3.2007994606816590, 3.2107759235502562, 3.2207593849316032, 3.2306742112715421,
3.2405587023112234, 3.2504131347991749, 3.2602752232365293, 3.2700702400713046,
3.2798360048560355, 3.2895727781126838, 3.2993178153786578, 3.3089972636170311,
3.3186484800856810, 3.3283083869662677, 3.3379037677111065, 3.3474716438306089,
3.3570122504989461, 3.3665620793882591, 3.3760487375221642, 3.3855088128485207,
3.3949784839156196, 3.4043859578490805, 3.4137675072784321, 3.4231233453528955,
3.4324892457042018, 3.4417941928048226, 3.4510740515635128, 3.4603290238249023,
3.4695944917958350, 3.4788001927748020, 3.4879815975718680, 3.4971738031409019,
3.5063070962374359, 3.5154166604934614, 3.5245026799003858, 3.5335998818485379,
3.5426392659640071, 3.5516556438511886, 3.5606491902811768, 3.5696542746637245,
3.5786025882144274, 3.5875285822032135, 3.5964663647113397, 3.6053481324623839,
3.6142080737002402, 3.6230463485511746, 3.6318967259718442, 3.6406920594682268,
3.6494661959833250, 3.6582526566654741, 3.6669847755001657, 3.6756961500510350,
3.6843869274616097, 3.6930903069956198, 3.7017402474207994, 3.7103700224000571,
3.7189797723132347, 3.7276023837381045, 3.7361724230822109, 3.7447228493908598,
3.7532863204297375, 3.7617978476886553, 3.7702901600042669, 3.7787633869263368,
3.7872498886065071, 3.7956852559847478, 3.8041019184887777, 3.8125000000000000,
3.8209115711273665, 3.8292727871131094, 3.8376157861196840, 3.8459724266107265,
3.8542792776341468, 3.8625682639598748, 3.8708395003538962, 3.8791245690071618,
3.8873605782876637, 3.8955791750874478, 3.9037804693815712, 3.9119957742180653,
3.9201627238228260, 3.9283126944020128, 3.9364768015796816, 3.9445930655930783,
3.9526926641056979, 3.9607756993580185, 3.9688730295891301, 3.9769231786332004,
3.9849570653270532, 3.9930053589840071, 3.9999694823054588, 3.9999694823054588};
/* testvector in Q4.12 */
static const uint32_t uv[252] = {
0U, 262U, 525U, 787U, 1049U, 1311U,
1574U, 1836U, 2098U, 2360U, 2623U, 2885U,
3147U, 3410U, 3672U, 3934U, 4196U, 4459U,
4721U, 4983U, 5246U, 5508U, 5770U, 6032U,
6295U, 6557U, 6819U, 7081U, 7344U, 7606U,
7868U, 8131U, 8393U, 8655U, 8917U, 9180U,
9442U, 9704U, 9966U, 10229U, 10491U, 10753U,
11016U, 11278U, 11540U, 11802U, 12065U, 12327U,
12589U, 12851U, 13114U, 13376U, 13638U, 13901U,
14163U, 14425U, 14687U, 14950U, 15212U, 15474U,
15737U, 15999U, 16261U, 16523U, 16786U, 17048U,
17310U, 17572U, 17835U, 18097U, 18359U, 18622U,
18884U, 19146U, 19408U, 19671U, 19933U, 20195U,
20457U, 20720U, 20982U, 21244U, 21507U, 21769U,
22031U, 22293U, 22556U, 22818U, 23080U, 23342U,
23605U, 23867U, 24129U, 24392U, 24654U, 24916U,
25178U, 25441U, 25703U, 25965U, 26228U, 26490U,
26752U, 27014U, 27277U, 27539U, 27801U, 28063U,
28326U, 28588U, 28850U, 29113U, 29375U, 29637U,
29899U, 30162U, 30424U, 30686U, 30948U, 31211U,
31473U, 31735U, 31998U, 32260U, 32522U, 32784U,
33047U, 33309U, 33571U, 33833U, 34096U, 34358U,
34620U, 34883U, 35145U, 35407U, 35669U, 35932U,
36194U, 36456U, 36719U, 36981U, 37243U, 37505U,
37768U, 38030U, 38292U, 38554U, 38817U, 39079U,
39341U, 39604U, 39866U, 40128U, 40390U, 40653U,
40915U, 41177U, 41439U, 41702U, 41964U, 42226U,
42489U, 42751U, 43013U, 43275U, 43538U, 43800U,
44062U, 44324U, 44587U, 44849U, 45111U, 45374U,
45636U, 45898U, 46160U, 46423U, 46685U, 46947U,
47210U, 47472U, 47734U, 47996U, 48259U, 48521U,
48783U, 49045U, 49308U, 49570U, 49832U, 50095U,
50357U, 50619U, 50881U, 51144U, 51406U, 51668U,
51930U, 52193U, 52455U, 52717U, 52980U, 53242U,
53504U, 53766U, 54029U, 54291U, 54553U, 54816U,
55078U, 55340U, 55602U, 55865U, 56127U, 56389U,
56651U, 56914U, 57176U, 57438U, 57701U, 57963U,
58225U, 58487U, 58750U, 59012U, 59274U, 59536U,
59799U, 60061U, 60323U, 60586U, 60848U, 61110U,
61372U, 61635U, 61897U, 62159U, 62421U, 62684U,
62946U, 63208U, 63471U, 63733U, 63995U, 64257U,
64520U, 64782U, 65044U, 65307U, UINT16_MAX, UINT16_MAX};
static void test_math_arithmetic_sqrt_fixed(void **state)
{
(void)state;
uint32_t u[252];
int i;
double y;
double diff;
memcpy_s((void *)&u[0], sizeof(u), (void *)&uv[0], 252U * sizeof(uint32_t));
for (i = 0; i < ARRAY_SIZE(sqrt_ref_table); i++) {
y = Q_CONVERT_QTOF(sqrt_int16(u[i]), 12);
diff = fabs(sqrt_ref_table[i] - y);
if (diff > CMP_TOLERANCE) {
printf("%s: diff for %.16f: reftbl = %.16f, sqrt = %.16f\n", __func__,
diff, (double)sqrt_ref_table[i], y);
assert_true(diff <= CMP_TOLERANCE);
}
}
}
int main(void)
{
const struct CMUnitTest tests[] = {
cmocka_unit_test(test_math_arithmetic_sqrt_fixed)
};
cmocka_set_message_output(CM_OUTPUT_TAP);
return cmocka_run_group_tests(tests, NULL, NULL);
}