diff options
| author | erdgeist <erdgeist@erdgeist.org> | 2025-08-15 12:42:40 +0200 |
|---|---|---|
| committer | erdgeist <erdgeist@erdgeist.org> | 2025-08-15 12:42:40 +0200 |
| commit | 30325d24d107dbf133da39f7c96d1510fd1c9449 (patch) | |
| tree | 932baa5b2a4475821f16dccf9e3e05011daa6d92 /comp_prim.h | |
| parent | 9022d768021bbe15c7815cc6f8b64218b46f0e10 (diff) | |
Bump to codec2 version 1.2.0erdgeist-bump-to-1.2.0
Diffstat (limited to 'comp_prim.h')
| -rw-r--r-- | comp_prim.h | 109 |
1 files changed, 53 insertions, 56 deletions
diff --git a/comp_prim.h b/comp_prim.h index d0f070a..e0166d3 100644 --- a/comp_prim.h +++ b/comp_prim.h | |||
| @@ -28,114 +28,111 @@ | |||
| 28 | #ifndef __COMP_PRIM__ | 28 | #ifndef __COMP_PRIM__ |
| 29 | #define __COMP_PRIM__ | 29 | #define __COMP_PRIM__ |
| 30 | 30 | ||
| 31 | #include <math.h> | ||
| 32 | |||
| 31 | /*---------------------------------------------------------------------------*\ | 33 | /*---------------------------------------------------------------------------*\ |
| 32 | 34 | ||
| 33 | FUNCTIONS | 35 | FUNCTIONS |
| 34 | 36 | ||
| 35 | \*---------------------------------------------------------------------------*/ | 37 | \*---------------------------------------------------------------------------*/ |
| 36 | 38 | ||
| 37 | inline static COMP cneg(COMP a) | 39 | inline static COMP cneg(COMP a) { |
| 38 | { | 40 | COMP res; |
| 39 | COMP res; | ||
| 40 | 41 | ||
| 41 | res.real = -a.real; | 42 | res.real = -a.real; |
| 42 | res.imag = -a.imag; | 43 | res.imag = -a.imag; |
| 43 | 44 | ||
| 44 | return res; | 45 | return res; |
| 45 | } | 46 | } |
| 46 | 47 | ||
| 47 | inline static COMP cconj(COMP a) | 48 | inline static COMP cconj(COMP a) { |
| 48 | { | 49 | COMP res; |
| 49 | COMP res; | ||
| 50 | 50 | ||
| 51 | res.real = a.real; | 51 | res.real = a.real; |
| 52 | res.imag = -a.imag; | 52 | res.imag = -a.imag; |
| 53 | 53 | ||
| 54 | return res; | 54 | return res; |
| 55 | } | 55 | } |
| 56 | 56 | ||
| 57 | inline static COMP cmult(COMP a, COMP b) | 57 | inline static COMP cmult(COMP a, COMP b) { |
| 58 | { | 58 | COMP res; |
| 59 | COMP res; | ||
| 60 | 59 | ||
| 61 | res.real = a.real*b.real - a.imag*b.imag; | 60 | res.real = a.real * b.real - a.imag * b.imag; |
| 62 | res.imag = a.real*b.imag + a.imag*b.real; | 61 | res.imag = a.real * b.imag + a.imag * b.real; |
| 63 | 62 | ||
| 64 | return res; | 63 | return res; |
| 65 | } | 64 | } |
| 66 | 65 | ||
| 67 | inline static COMP fcmult(float a, COMP b) | 66 | inline static COMP fcmult(float a, COMP b) { |
| 68 | { | 67 | COMP res; |
| 69 | COMP res; | ||
| 70 | 68 | ||
| 71 | res.real = a*b.real; | 69 | res.real = a * b.real; |
| 72 | res.imag = a*b.imag; | 70 | res.imag = a * b.imag; |
| 73 | 71 | ||
| 74 | return res; | 72 | return res; |
| 75 | } | 73 | } |
| 76 | 74 | ||
| 77 | inline static COMP cadd(COMP a, COMP b) | 75 | inline static COMP cadd(COMP a, COMP b) { |
| 78 | { | 76 | COMP res; |
| 79 | COMP res; | ||
| 80 | 77 | ||
| 81 | res.real = a.real + b.real; | 78 | res.real = a.real + b.real; |
| 82 | res.imag = a.imag + b.imag; | 79 | res.imag = a.imag + b.imag; |
| 83 | 80 | ||
| 84 | return res; | 81 | return res; |
| 85 | } | 82 | } |
| 86 | 83 | ||
| 87 | inline static float cabsolute(COMP a) | 84 | inline static float cabsolute(COMP a) { |
| 88 | { | 85 | return sqrtf((a.real * a.real) + (a.imag * a.imag)); |
| 89 | return sqrtf((a.real * a.real) + (a.imag * a.imag) ); | ||
| 90 | } | 86 | } |
| 91 | 87 | ||
| 92 | /* | 88 | /* |
| 93 | * Euler's formula in a new convenient function | 89 | * Euler's formula in a new convenient function |
| 94 | */ | 90 | */ |
| 95 | inline static COMP comp_exp_j(float phi){ | 91 | inline static COMP comp_exp_j(float phi) { |
| 96 | COMP res; | 92 | COMP res; |
| 97 | res.real = cosf(phi); | 93 | res.real = cosf(phi); |
| 98 | res.imag = sinf(phi); | 94 | res.imag = sinf(phi); |
| 99 | return res; | 95 | return res; |
| 100 | } | 96 | } |
| 101 | 97 | ||
| 102 | /* | 98 | /* |
| 103 | * Quick and easy complex 0 | 99 | * Quick and easy complex 0 |
| 104 | */ | 100 | */ |
| 105 | inline static COMP comp0(){ | 101 | inline static COMP comp0() { |
| 106 | COMP res; | 102 | COMP res; |
| 107 | res.real = 0; | 103 | res.real = 0; |
| 108 | res.imag = 0; | 104 | res.imag = 0; |
| 109 | return res; | 105 | return res; |
| 110 | } | 106 | } |
| 111 | 107 | ||
| 112 | /* | 108 | /* |
| 113 | * Quick and easy complex subtract | 109 | * Quick and easy complex subtract |
| 114 | */ | 110 | */ |
| 115 | inline static COMP csub(COMP a, COMP b){ | 111 | inline static COMP csub(COMP a, COMP b) { |
| 116 | COMP res; | 112 | COMP res; |
| 117 | res.real = a.real-b.real; | 113 | res.real = a.real - b.real; |
| 118 | res.imag = a.imag-b.imag; | 114 | res.imag = a.imag - b.imag; |
| 119 | return res; | 115 | return res; |
| 120 | } | 116 | } |
| 121 | 117 | ||
| 122 | /* | 118 | /* |
| 123 | * Compare the magnitude of a and b. if |a|>|b|, return true, otw false. | 119 | * Compare the magnitude of a and b. if |a|>|b|, return true, otw false. |
| 124 | * This needs no square roots | 120 | * This needs no square roots |
| 125 | */ | 121 | */ |
| 126 | inline static int comp_mag_gt(COMP a,COMP b){ | 122 | inline static int comp_mag_gt(COMP a, COMP b) { |
| 127 | return ((a.real*a.real)+(a.imag*a.imag)) > ((b.real*b.real)+(b.imag*b.imag)); | 123 | return ((a.real * a.real) + (a.imag * a.imag)) > |
| 124 | ((b.real * b.real) + (b.imag * b.imag)); | ||
| 128 | } | 125 | } |
| 129 | 126 | ||
| 130 | /* | 127 | /* |
| 131 | * Normalize a complex number's magnitude to 1 | 128 | * Normalize a complex number's magnitude to 1 |
| 132 | */ | 129 | */ |
| 133 | inline static COMP comp_normalize(COMP a){ | 130 | inline static COMP comp_normalize(COMP a) { |
| 134 | COMP b; | 131 | COMP b; |
| 135 | float av = cabsolute(a); | 132 | float av = cabsolute(a); |
| 136 | b.real = a.real/av; | 133 | b.real = a.real / av; |
| 137 | b.imag = a.imag/av; | 134 | b.imag = a.imag / av; |
| 138 | return b; | 135 | return b; |
| 139 | } | 136 | } |
| 140 | 137 | ||
| 141 | #endif | 138 | #endif |
