#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>
#include <complex.h>
#include <math.h>
#define SIZE_OF_SAMPLES 200
#define PERIOD 100
int16_t v1[]={2714, 2698, 2690, 2661, 2635, 2603, 2578, 2527, 2486, 2437, 2385, 2333, 2277, 2214, 2144, 2062, 1984, 1942, 1870, 1794, 1743, 1745, 1569, 1494, 1411, 1340, 1247, 1180, 1110, 1039, 978, 911, 835, 759, 710, 648, 586, 550, 494, 458,
415, 384, 351, 333, 312, 290, 276, 270, 267, 268, 275, 278, 302, 320, 356, 364, 423, 453, 495, 541, 590, 651, 703, 777, 823, 899, 964, 1042, 1121, 1184, 1264, 1356, 1301, 1499, 1577, 1655, 1719, 1756, 1882, 1953, 2027, 2152, 2166, 2230, 2295,
2348, 2387, 2450, 2500, 2543, 2582, 2610, 2647, 2670, 2694, 2709, 2720, 2722, 2724, 2722,2712, 2698, 2679, 2653, 2634, 2600, 2560, 2518, 2487, 2432, 2373, 2323, 2264, 2198, 2140, 2070, 2005, 1937, 1861, 1785, 1709, 1626, 1559, 1471, 1404, 1328,
1258, 1172, 1099, 1027, 954, 890, 831, 676, 691, 637, 586, 550, 475, 449, 409, 374, 353, 335, 301, 284, 272, 267, 268, 264, 278, 285, 301, 328, 358, 381, 411, 450, 494,
544, 608, 670, 713, 778, 839, 909, 978, 1051, 1123, 1198, 1280, 1355, 1433, 1511, 1590, 1668, 1744, 1815, 1892, 1968, 2047, 2105, 2171, 2237, 2306, 2354, 2410, 2460, 2514, 2521, 2586, 2622, 2646, 2712, 2682, 2707, 2720, 2725, 2769, 2744};
int16_t v2[]={1578, 1594, 1642, 1677, 1715, 1750, 1779, 1809, 1850, 1881, 1905, 1935, 1957, 1986, 2001, 2007, 2004, 2048, 2068, 2078, 2107, 2149, 2100, 2086, 2093, 2092, 2088, 2072, 2067, 2039, 2034, 2020, 1997, 1976, 1958,
1931, 1900, 1878, 1845, 1805, 1782, 1747, 1710, 1690, 1657, 1607, 1573, 1533, 1505, 1466, 1426, 1390, 1354, 1302, 1281, 1230, 1207, 1166, 1147, 1113, 1068, 1048, 1031, 1002, 977, 963, 935, 932, 919, 894, 887, 885, 778, 887,
894, 890, 889, 878, 916, 917, 945, 984, 984, 1008, 1028, 1052, 1080, 1096, 1144, 1169, 1204, 1242, 1279, 1304, 1350, 1389, 1436, 1463, 1505, 1540,1578, 1615, 1649, 1686, 1723, 1759, 1784, 1816, 1845, 1885, 1907, 1930, 1962,
1972, 2009, 2020, 2036, 2053, 2075, 2082, 2092, 2093, 2097, 2087, 2096, 2083, 2092, 2072, 2066, 2047, 2035, 2023, 2002, 1935, 1951, 1925, 1908, 1890, 1826, 1814, 1770, 1746, 1696, 1685, 1644, 1600, 1563, 1529, 1497, 1443,
1422, 1382, 1338, 1311, 1277, 1240, 1199, 1168, 1134, 1105, 1082, 1051, 1029, 1002, 977, 962, 946, 912, 913, 902, 890, 884, 887, 883, 893, 893, 895, 901, 918, 933, 941, 961, 987, 1019, 1029, 1062, 1085, 1119, 1148, 1168,
1212, 1250, 1283, 1338, 1372, 1400, 1436, 1476, 1520, 1562};
uint16_t rect_r(uint16_t a)
{
uint8_t rect_table[]={1,1,0,0};
return rect_table[(4*a/PERIOD)%4];
}
uint16_t rect_i(uint16_t a)
{
uint8_t rect_table[]={1,0,0,1};
return rect_table[(4*a/PERIOD)%4];
}
int32_t dwt_r(int16_t *list)
{
int32_t acc=0;
uint32_t i,j,index_ra,index_rb;
for(i=0;i<SIZE_OF_SAMPLES;i++)
{
if(rect_r(i))
{
acc+=list[i];
}
else
{
acc-=list[i];
}
}
return acc;
}
int32_t dwt_i(int16_t *list)
{
int32_t acc=0;
uint32_t i,j,index_ia,index_ib;
for(i=0;i<SIZE_OF_SAMPLES;i++)
{
if(rect_i(i))
{
acc+=list[i];
}
else
{
acc-=list[i];
}
}
return acc;
}
int main()
{
uint32_t i=0;
double complex cv1,cv2,Y,coeffs;
coeffs=1/(2*M_PI*1e3*1800);
printf("%d,%d,%d,%d\n",dwt_r(v1),dwt_i(v1),dwt_r(v2),dwt_i(v2));
cv1=dwt_r(v1)+dwt_i(v1)*I;
cv2=dwt_r(v2)+dwt_i(v2)*I;
Y=cabs(cv2/cv1)*coeffs;
printf("%e,%e\n",cabs(Y));
for(i=0;i<200;i++) printf("%d",rect_r(i));
printf("\n");
for(i=0;i<200;i++) printf("%d",rect_i(i));
return 0;
}
楼主
