|
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439 |
-
-
-
- #include <math.h>
-
-
- #include "math_helper.h"
-
-
-
- float arm_snr_f32(float *pRef, float *pTest, uint32_t buffSize)
- {
- float EnergySignal = 0.0;
- float EnergyError = 0.0;
- uint32_t i;
- float SNR;
- int temp;
- int *test;
-
- for (i = 0; i < buffSize; i++) {
-
- test = (int *)(&pRef[i]);
- temp = *test;
-
- if (temp == 0x7FC00000) {
- return(0);
- }
-
-
- test = (int *)(&pTest[i]);
- temp = *test;
-
- if (temp == 0x7FC00000) {
- return(0);
- }
- EnergySignal += pRef[i] * pRef[i];
- EnergyError += (pRef[i] - pTest[i]) * (pRef[i] - pTest[i]);
- }
-
-
- test = (int *)(&EnergyError);
- temp = *test;
-
- if(temp == 0x7FC00000) {
- return(0);
- }
-
- SNR = 10 * log10f(EnergySignal / EnergyError);
- return (SNR);
- }
-
-
-
-
- void arm_provide_guard_bits_q15 (q15_t * input_buf, uint32_t blockSize,
- uint32_t guard_bits)
- {
- uint32_t i;
-
- for (i = 0; i < blockSize; i++)
- {
- input_buf[i] = input_buf[i] >> guard_bits;
- }
- }
-
-
-
- void arm_float_to_q12_20(float *pIn, q31_t * pOut, uint32_t numSamples)
- {
- uint32_t i;
-
- for (i = 0; i < numSamples; i++) {
-
- pOut[i] = (q31_t) (pIn[i] * 1048576.0f);
-
- pOut[i] += pIn[i] > 0 ? 0.5 : -0.5;
-
- if (pIn[i] == (float) 1.0) {
- pOut[i] = 0x000FFFFF;
- }
- }
- }
-
-
-
- uint32_t arm_compare_fixed_q15(q15_t *pIn, q15_t * pOut, uint32_t numSamples)
- {
- uint32_t i;
- int32_t diff, diffCrnt = 0;
- uint32_t maxDiff = 0;
-
- for (i = 0; i < numSamples; i++)
- {
- diff = pIn[i] - pOut[i];
- diffCrnt = (diff > 0) ? diff : -diff;
-
- if(diffCrnt > maxDiff)
- {
- maxDiff = diffCrnt;
- }
- }
-
- return(maxDiff);
- }
-
-
-
- uint32_t arm_compare_fixed_q31(q31_t *pIn, q31_t * pOut, uint32_t numSamples)
- {
- uint32_t i;
- int32_t diff, diffCrnt = 0;
- uint32_t maxDiff = 0;
-
- for (i = 0; i < numSamples; i++)
- {
- diff = pIn[i] - pOut[i];
- diffCrnt = (diff > 0) ? diff : -diff;
-
- if(diffCrnt > maxDiff)
- {
- maxDiff = diffCrnt;
- }
- }
-
- return(maxDiff);
- }
-
-
-
- void arm_provide_guard_bits_q31 (q31_t * input_buf,
- uint32_t blockSize,
- uint32_t guard_bits)
- {
- uint32_t i;
-
- for (i = 0; i < blockSize; i++)
- {
- input_buf[i] = input_buf[i] >> guard_bits;
- }
- }
-
-
-
- void arm_provide_guard_bits_q7 (q7_t * input_buf,
- uint32_t blockSize,
- uint32_t guard_bits)
- {
- uint32_t i;
-
- for (i = 0; i < blockSize; i++)
- {
- input_buf[i] = input_buf[i] >> guard_bits;
- }
- }
-
-
-
-
-
- uint32_t arm_calc_guard_bits (uint32_t num_adds)
- {
- uint32_t i = 1, j = 0;
-
- if (num_adds == 1)
- {
- return (0);
- }
-
- while (i < num_adds)
- {
- i = i * 2;
- j++;
- }
-
- return (j);
- }
-
-
-
- void arm_apply_guard_bits (float32_t * pIn,
- uint32_t numSamples,
- uint32_t guard_bits)
- {
- uint32_t i;
-
- for (i = 0; i < numSamples; i++)
- {
- pIn[i] = pIn[i] * arm_calc_2pow(guard_bits);
- }
- }
-
-
- uint32_t arm_calc_2pow(uint32_t numShifts)
- {
-
- uint32_t i, val = 1;
-
- for (i = 0; i < numShifts; i++)
- {
- val = val * 2;
- }
-
- return(val);
- }
-
-
-
-
-
- void arm_float_to_q14 (float *pIn, q15_t * pOut,
- uint32_t numSamples)
- {
- uint32_t i;
-
- for (i = 0; i < numSamples; i++)
- {
-
- pOut[i] = (q15_t) (pIn[i] * 16384.0f);
-
- pOut[i] += pIn[i] > 0 ? 0.5 : -0.5;
-
- if (pIn[i] == (float) 2.0)
- {
- pOut[i] = 0x7FFF;
- }
-
- }
-
- }
-
-
-
-
- void arm_float_to_q30 (float *pIn, q31_t * pOut,
- uint32_t numSamples)
- {
- uint32_t i;
-
- for (i = 0; i < numSamples; i++)
- {
-
- pOut[i] = (q31_t) (pIn[i] * 1073741824.0f);
-
- pOut[i] += pIn[i] > 0 ? 0.5 : -0.5;
-
- if (pIn[i] == (float) 2.0)
- {
- pOut[i] = 0x7FFFFFFF;
- }
- }
- }
-
-
-
- void arm_float_to_q29 (float *pIn, q31_t * pOut,
- uint32_t numSamples)
- {
- uint32_t i;
-
- for (i = 0; i < numSamples; i++)
- {
-
- pOut[i] = (q31_t) (pIn[i] * 536870912.0f);
-
- pOut[i] += pIn[i] > 0 ? 0.5 : -0.5;
-
- if (pIn[i] == (float) 4.0)
- {
- pOut[i] = 0x7FFFFFFF;
- }
- }
- }
-
-
-
-
- void arm_float_to_q28 (float *pIn, q31_t * pOut,
- uint32_t numSamples)
- {
- uint32_t i;
-
- for (i = 0; i < numSamples; i++)
- {
-
- pOut[i] = (q31_t) (pIn[i] * 268435456.0f);
-
- pOut[i] += pIn[i] > 0 ? 0.5 : -0.5;
-
- if (pIn[i] == (float) 8.0)
- {
- pOut[i] = 0x7FFFFFFF;
- }
- }
- }
-
-
-
- void arm_clip_f32 (float *pIn, uint32_t numSamples)
- {
- uint32_t i;
-
- for (i = 0; i < numSamples; i++)
- {
- if(pIn[i] > 1.0f)
- {
- pIn[i] = 1.0;
- }
- else if( pIn[i] < -1.0f)
- {
- pIn[i] = -1.0;
- }
-
- }
- }
-
-
-
-
|