/***************************************************************** >file name : apps/common/sine_make.c >author : lichao >create time : Sun 05 May 2019 08:37:35 PM CST *****************************************************************/ #include "system/includes.h" #include "sine_make.h" #define SINE_USE_MALLOC 1 struct audio_sin_maker { u8 open; u8 id; u8 sin_num; u8 channel; u8 repeat; u8 next_param; u16 fade_points; /*int sample_rate;*/ int volume; int points; int sin_index; int win_sin_index; const struct sin_param *sin; }; #ifndef SINE_USE_MALLOC static struct audio_sin_maker sin_maker_handle; #endif void *sin_tone_open(const struct sin_param *param, int num, u8 channel, u8 repeat) { if (!param || !num) { return NULL; } #ifdef SINE_USE_MALLOC struct audio_sin_maker *sin = zalloc(sizeof(struct audio_sin_maker)); #else struct audio_sin_maker *sin = &sin_maker_handle; #endif if (!sin) { return NULL; } if (sin->open) { return NULL; } sin->sin = param; sin->sin_num = num; sin->open = 1; sin->points = param[0].points; sin->id = 0; sin->channel = channel; sin->repeat = repeat; #if (defined CONFIG_CPU_BR18 || \ CONFIG_CPU_BR21) /*这里如果加多fade points，会导致结束的时候有噪声,不是在淡出尾部*/ sin->fade_points = 0; #else sin->fade_points = 480; #endif sin->next_param = 1; return (void *)sin; } #if !defined(SINE_MAKE_IN_MASK) const int sf_sin_tab1[513] = { 0x00000000, 0x0000c910, 0x0001921f, 0x00025b2d, 0x0003243a, 0x0003ed45, 0x0004b64e, 0x00057f53, 0x00064855, 0x00071154, 0x0007da4e, 0x0008a343, 0x00096c33, 0x000a351d, 0x000afe00, 0x000bc6dd, 0x000c8fb3, 0x000d5881, 0x000e2147, 0x000eea03, 0x000fb2b7, 0x00107b61, 0x00114401, 0x00120c96, 0x0012d521, 0x00139d9f, 0x00146611, 0x00152e77, 0x0015f6d0, 0x0016bf1b, 0x00178758, 0x00184f87, 0x001917a7, 0x0019dfb7, 0x001aa7b7, 0x001b6fa7, 0x001c3786, 0x001cff53, 0x001dc70f, 0x001e8eb8, 0x001f564e, 0x00201dd1, 0x0020e541, 0x0021ac9b, 0x002273e2, 0x00233b13, 0x0024022e, 0x0024c933, 0x00259021, 0x002656f8, 0x00271db7, 0x0027e45f, 0x0028aaed, 0x00297163, 0x002a37bf, 0x002afe01, 0x002bc429, 0x002c8a35, 0x002d5026, 0x002e15fb, 0x002edbb4, 0x002fa14f, 0x003066ce, 0x00312c2e, 0x0031f170, 0x0032b694, 0x00337b98, 0x0034407c, 0x00350540, 0x0035c9e4, 0x00368e66, 0x003752c6, 0x00381705, 0x0038db21, 0x00399f19, 0x003a62ef, 0x003b26a0, 0x003bea2c, 0x003cad94, 0x003d70d7, 0x003e33f3, 0x003ef6e9, 0x003fb9b8, 0x00407c60, 0x00413ee0, 0x00420138, 0x0042c367, 0x0043856d, 0x0044474a, 0x004508fc, 0x0045ca83, 0x00468be0, 0x00474d11, 0x00480e16, 0x0048ceef, 0x00498f9a, 0x004a5019, 0x004b1069, 0x004bd08b, 0x004c907f, 0x004d5043, 0x004e0fd8, 0x004ecf3c, 0x004f8e70, 0x00504d72, 0x00510c43, 0x0051cae3, 0x0052894f, 0x00534789, 0x0054058f, 0x0054c362, 0x00558100, 0x00563e6a, 0x0056fb9e, 0x0057b89d, 0x00587565, 0x005931f7, 0x0059ee52, 0x005aaa76, 0x005b6662, 0x005c2215, 0x005cdd8f, 0x005d98d0, 0x005e53d8, 0x005f0ea5, 0x005fc937, 0x0060838f, 0x00613dab, 0x0061f78b, 0x0062b12e, 0x00636a95, 0x006423be, 0x0064dcaa, 0x00659557, 0x00664dc6, 0x006705f5, 0x0067bde5, 0x00687595, 0x00692d05, 0x0069e433, 0x006a9b21, 0x006b51cc, 0x006c0836, 0x006cbe5c, 0x006d7440, 0x006e29e0, 0x006edf3d, 0x006f9454, 0x00704927, 0x0070fdb5, 0x0071b1fd, 0x007265ff, 0x007319ba, 0x0073cd2f, 0x0074805c, 0x00753341, 0x0075e5dd, 0x00769831, 0x00774a3c, 0x0077fbfe, 0x0078ad75, 0x00795ea2, 0x007a0f84, 0x007ac01a, 0x007b7065, 0x007c2064, 0x007cd016, 0x007d7f7c, 0x007e2e93, 0x007edd5d, 0x007f8bd9, 0x00803a06, 0x0080e7e4, 0x00819573, 0x008242b1, 0x0082ef9f, 0x00839c3d, 0x00844889, 0x0084f484, 0x0085a02c, 0x00864b82, 0x0086f686, 0x0087a136, 0x00884b92, 0x0088f59b, 0x00899f4e, 0x008a48ad, 0x008af1b7, 0x008b9a6b, 0x008c42c9, 0x008cead0, 0x008d9281, 0x008e39da, 0x008ee0db, 0x008f8784, 0x00902dd5, 0x0090d3cd, 0x0091796b, 0x00921eb0, 0x0092c39a, 0x0093682a, 0x00940c5f, 0x0094b039, 0x009553b7, 0x0095f6d9, 0x0096999f, 0x00973c07, 0x0097de12, 0x00987fc0, 0x0099210f, 0x0099c200, 0x009a6293, 0x009b02c6, 0x009ba299, 0x009c420c, 0x009ce11f, 0x009d7fd1, 0x009e1e22, 0x009ebc12, 0x009f599f, 0x009ff6cb, 0x00a09393, 0x00a12ff9, 0x00a1cbfb, 0x00a26799, 0x00a302d3, 0x00a39da9, 0x00a4381a, 0x00a4d225, 0x00a56bcb, 0x00a6050a, 0x00a69de3, 0x00a73656, 0x00a7ce61, 0x00a86605, 0x00a8fd41, 0x00a99415, 0x00aa2a80, 0x00aac082, 0x00ab561b, 0x00abeb4a, 0x00ac800f, 0x00ad1469, 0x00ada859, 0x00ae3bde, 0x00aecef7, 0x00af61a5, 0x00aff3e6, 0x00b085bb, 0x00b11722, 0x00b1a81d, 0x00b238aa, 0x00b2c8c9, 0x00b3587a, 0x00b3e7bc, 0x00b4768f, 0x00b504f3, 0x00b592e7, 0x00b6206c, 0x00b6ad7f, 0x00b73a23, 0x00b7c655, 0x00b85216, 0x00b8dd65, 0x00b96842, 0x00b9f2ac, 0x00ba7ca4, 0x00bb0629, 0x00bb8f3b, 0x00bc17d9, 0x00bca003, 0x00bd27b8, 0x00bdaef9, 0x00be35c5, 0x00bebc1b, 0x00bf41fc, 0x00bfc767, 0x00c04c5c, 0x00c0d0da, 0x00c154e1, 0x00c1d870, 0x00c25b89, 0x00c2de29, 0x00c36051, 0x00c3e200, 0x00c46337, 0x00c4e3f5, 0x00c56439, 0x00c5e403, 0x00c66354, 0x00c6e22a, 0x00c76085, 0x00c7de65, 0x00c85bca, 0x00c8d8b3, 0x00c95521, 0x00c9d112, 0x00ca4c87, 0x00cac77f, 0x00cb41fa, 0x00cbbbf8, 0x00cc3578, 0x00ccae79, 0x00cd26fd, 0x00cd9f02, 0x00ce1689, 0x00ce8d90, 0x00cf0417, 0x00cf7a1f, 0x00cfefa8, 0x00d064af, 0x00d0d937, 0x00d14d3d, 0x00d1c0c2, 0x00d233c6, 0x00d2a649, 0x00d31849, 0x00d389c7, 0x00d3fac3, 0x00d46b3b, 0x00d4db31, 0x00d54aa4, 0x00d5b993, 0x00d627fe, 0x00d695e5, 0x00d70348, 0x00d77026, 0x00d7dc7f, 0x00d84853, 0x00d8b3a1, 0x00d91e6a, 0x00d988ad, 0x00d9f26a, 0x00da5ba0, 0x00dac450, 0x00db2c79, 0x00db941a, 0x00dbfb34, 0x00dc61c7, 0x00dcc7d1, 0x00dd2d53, 0x00dd924d, 0x00ddf6be, 0x00de5aa6, 0x00debe05, 0x00df20db, 0x00df8327, 0x00dfe4e9, 0x00e04621, 0x00e0a6cf, 0x00e106f2, 0x00e1668a, 0x00e1c598, 0x00e2241a, 0x00e28210, 0x00e2df7b, 0x00e33c5a, 0x00e398ac, 0x00e3f473, 0x00e44fac, 0x00e4aa59, 0x00e50479, 0x00e55e0b, 0x00e5b710, 0x00e60f88, 0x00e66771, 0x00e6becc, 0x00e71599, 0x00e76bd8, 0x00e7c187, 0x00e816a8, 0x00e86b39, 0x00e8bf3c, 0x00e912ae, 0x00e96591, 0x00e9b7e4, 0x00ea09a7, 0x00ea5ad9, 0x00eaab7b, 0x00eafb8c, 0x00eb4b0c, 0x00eb99fb, 0x00ebe858, 0x00ec3624, 0x00ec835e, 0x00ecd007, 0x00ed1c1d, 0x00ed67a1, 0x00edb293, 0x00edfcf2, 0x00ee46be, 0x00ee8ff8, 0x00eed89e, 0x00ef20b0, 0x00ef6830, 0x00efaf1b, 0x00eff573, 0x00f03b37, 0x00f08066, 0x00f0c501, 0x00f10908, 0x00f14c7a, 0x00f18f57, 0x00f1d19f, 0x00f21352, 0x00f25470, 0x00f294f8, 0x00f2d4eb, 0x00f31447, 0x00f3530e, 0x00f3913f, 0x00f3ced9, 0x00f40bdd, 0x00f4484b, 0x00f48422, 0x00f4bf62, 0x00f4fa0b, 0x00f5341d, 0x00f56d97, 0x00f5a67b, 0x00f5dec6, 0x00f6167a, 0x00f64d97, 0x00f6841b, 0x00f6ba07, 0x00f6ef5b, 0x00f72417, 0x00f7583a, 0x00f78bc5, 0x00f7beb7, 0x00f7f110, 0x00f822d1, 0x00f853f8, 0x00f88486, 0x00f8b47b, 0x00f8e3d6, 0x00f91298, 0x00f940c0, 0x00f96e4e, 0x00f99b43, 0x00f9c79d, 0x00f9f35e, 0x00fa1e84, 0x00fa4910, 0x00fa7302, 0x00fa9c59, 0x00fac516, 0x00faed37, 0x00fb14be, 0x00fb3bab, 0x00fb61fc, 0x00fb87b2, 0x00fbaccd, 0x00fbd14d, 0x00fbf531, 0x00fc187a, 0x00fc3b28, 0x00fc5d3a, 0x00fc7eb0, 0x00fc9f8a, 0x00fcbfc9, 0x00fcdf6c, 0x00fcfe73, 0x00fd1cdd, 0x00fd3aac, 0x00fd57de, 0x00fd7474, 0x00fd906e, 0x00fdabcc, 0x00fdc68c, 0x00fde0b1, 0x00fdfa38, 0x00fe1324, 0x00fe2b72, 0x00fe4323, 0x00fe5a38, 0x00fe70b0, 0x00fe868b, 0x00fe9bc9, 0x00feb069, 0x00fec46d, 0x00fed7d4, 0x00feea9d, 0x00fefcc9, 0x00ff0e58, 0x00ff1f49, 0x00ff2f9d, 0x00ff3f54, 0x00ff4e6d, 0x00ff5ce9, 0x00ff6ac7, 0x00ff7808, 0x00ff84ab, 0x00ff90b1, 0x00ff9c18, 0x00ffa6e3, 0x00ffb10f, 0x00ffba9e, 0x00ffc38f, 0x00ffcbe2, 0x00ffd397, 0x00ffdaaf, 0x00ffe129, 0x00ffe705, 0x00ffec43, 0x00fff0e3, 0x00fff4e6, 0x00fff84a, 0x00fffb11, 0x00fffd39, 0x00fffec4, 0x00ffffb1, 0x00ffffff, }; #else extern const int sf_sin_tab1[513] ; #endif #define SINE_INT_ZOOM 16384 #define SINE_INT_ZBIT 14 #define __int64 long long /*软件索引实现sin生成*/ static int get_sine_value(int mx_idx) { int ret = 0; int idx = 0; int tm_idx = mx_idx & 0x1FFFFFF; //2^25 int phase = tm_idx & 0x3FFF; int tp_idx0 = tm_idx >> 14; int tp_idx1 = tp_idx0 + 1; int sign = 1, dt0, dt1; if (tp_idx0 > 1024) { sign = -1; tp_idx0 = 2048 - tp_idx0; } if (tp_idx0 < 513) { dt0 = sf_sin_tab1[tp_idx0]; } else { dt0 = sf_sin_tab1[1024 - tp_idx0]; } if (tp_idx1 > 1024) { sign = -1; tp_idx1 = 2048 - tp_idx1; } if (tp_idx1 < 513) { dt1 = sf_sin_tab1[tp_idx1]; } else { dt1 = sf_sin_tab1[1024 - tp_idx1]; } ret = ((__int64)dt0 * (SINE_INT_ZOOM - phase) + (__int64)dt1 * phase) >> SINE_INT_ZBIT; ret *= sign; return ret; } static void hw_sin_value(int a, int *sin_res, u8 precision) { u64 s64 = a; *sin_res = __asm_sine(s64, precision); } int sin_tone_make(void *_maker, void *data, int len) { struct audio_sin_maker *maker = (struct audio_sin_maker *)_maker; s16 *pcm = (s16 *)data; int sin_value = 0; int win_sin_value = 0; int add_idx = 0, sub_vol = 0, win_add_idx = 0; int offset = 0; u8 id = maker->id; u8 sin_num = maker->sin_num; u8 repeat = maker->repeat; u8 channel = maker->channel; int sin_index; int win_sin_index; int volume; u32 reamin_points = len / 2 / channel; do { if (maker->next_param) { maker->volume = SINE_TOTAL_VOLUME; maker->sin_index = 0; maker->win_sin_index = 0; maker->next_param = 0; } u8 win = maker->sin[id].win; add_idx = ((u64)(1 << 25) * maker->sin[id].freq / DEFAULT_SINE_SAMPLE_RATE) >> 9; if (win) { win_add_idx = ((u64)(1 << 25) * maker->sin[id].decay / DEFAULT_SINE_SAMPLE_RATE) >> 9; /*sub_vol = 0;*/ } else { sub_vol = maker->sin[id].decay; } sin_index = maker->sin_index; win_sin_index = maker->win_sin_index; volume = maker->volume; u32 points = 0; if (maker->fade_points) { points = maker->fade_points > reamin_points ? reamin_points : maker->fade_points; sub_vol = 0; maker->fade_points -= points; } else { points = maker->points > reamin_points ? reamin_points : maker->points; maker->points -= points; } reamin_points -= points; while (points--) { /*hw_sin_value(sin_index, &sin_value, 0);*/ sin_value = __asm_sine((s64)sin_index, 2); if (win) { /*hw_sin_value(win_sin_index, &win_sin_value, 0);*/ win_sin_value = __asm_sine((s64)win_sin_index, 2); #ifdef CONFIG_CPU_BR36 sin_value = ((s64)sin_value * (s64)win_sin_value) >> 44; #else sin_value = ((s64)sin_value * (s64)win_sin_value) >> 34; #endif win_sin_index += win_add_idx; win_sin_index &= 0x1ffffff; } else { #ifdef CONFIG_CPU_BR36 sin_value = ((s64)volume * sin_value) >> 39; #else sin_value = ((s64)volume * sin_value) >> 34; #endif } sin_index += add_idx; sin_index &= 0x1ffffff; volume -= sub_vol; if (volume < 0) { volume = 0; } *pcm++ = sin_value; if (channel == 2) { *pcm++ = sin_value; } else if (channel == 4) { *pcm++ = sin_value; *pcm++ = sin_value; *pcm++ = sin_value; } } maker->volume = volume; maker->sin_index = sin_index; maker->win_sin_index = win_sin_index; if (!maker->points) { if (++id >= sin_num) { if (!repeat) { break; } id = 0; } maker->points = maker->sin[id].points; maker->id = id; maker->next_param = 1; } if (!reamin_points) { break; } } while (1); return len - (reamin_points * 2 * channel); } int sin_tone_points(void *_maker) { struct audio_sin_maker *maker = (struct audio_sin_maker *)_maker; int points = 0; u8 i = 0; for (i = 0; i < maker->sin_num; i++) { points += maker->sin[i].points; } return points; } void sin_tone_close(void *_maker) { struct audio_sin_maker *maker = (struct audio_sin_maker *)_maker; #ifdef SINE_USE_MALLOC if (maker) { free(maker); } #else if (sin_maker_handle.open) { sin_maker_handle.open = 0; } #endif }