| @@ -6,6 +6,9 @@ · 5 unmodified lines |
| 6 | 6 | */ |
| 7 | 7 | |
| 8 | 8 | |
| 9 | +#include "../Inc/leaf-WDF.h" |
| 10 | + |
| 11 | +//WDF resistor |
| 9 | 12 | void tWDFresistor_init(tWDFresistor* const r, float electrical_resistance) |
| 10 | 13 | { |
| 11 | 14 | r->port_resistance = electrical_resistance; |
| @@ -22,11 +25,136 @@ void tWDFresistor_setIncidentWave(tWDFresistor* const r, float incident_wave) · 10 unmodified lines |
| 22 | 25 | { |
| 23 | 26 | r->incident_wave = incident_wave; |
| 24 | 27 | } |
| 28 | +float tWDFresistor_getReflectedWave(tWDFresistor* const r) |
| 29 | +{ |
| 30 | + r->reflected_wave = 0.0f; |
| 31 | + return r->reflected_wave; |
| 32 | +} |
| 25 | 33 | float tWDFresistor_getVoltage(tWDFresistor* const r) |
| 26 | 34 | { |
| 27 | 35 | return ((r->incident_wave * 0.5f) + (r->reflected_wave * 0.5f)); |
| 28 | 36 | } |
| 29 | 37 | float tWDFresistor_getCurrent(tWDFresistor* const r) |
| 30 | 38 | { |
| 31 | | − return (((r->incident_wave * 0.5f) - (r->reflected_wave * 0.5f)) / r->port_conductance); |
| 39 | + return (((r->incident_wave * 0.5f) - (r->reflected_wave * 0.5f)) * r->port_conductance); |
| 40 | +} |
| 41 | + |
| 42 | + |
| 43 | + |
| 44 | +///----WDF resistive source |
| 45 | +void tWDFresistiveSource_init(tWDFresistiveSource* const r, float electrical_resistance, float source_voltage) |
| 46 | +{ |
| 47 | + r->port_resistance = electrical_resistance; |
| 48 | + r->port_conductance = 1.0f / electrical_resistance; |
| 49 | + r->electrical_resistance = electrical_resistance; |
| 50 | + r->incident_wave = 0.0f; |
| 51 | + r->reflected_wave = 0.0f; |
| 52 | + r->source_voltage = source_voltage; |
| 53 | +} |
| 54 | +float tWDFresistiveSource_getPortResistance(tWDFresistiveSource* const r) |
| 55 | +{ |
| 56 | + return r->port_resistance; |
| 57 | +} |
| 58 | +void tWDFresistiveSource_setIncidentWave(tWDFresistiveSource* const r, float incident_wave) |
| 59 | +{ |
| 60 | + r->incident_wave = incident_wave; |
| 61 | +} |
| 62 | +float tWDFresistiveSource_getReflectedWave(tWDFresistiveSource* const r) |
| 63 | +{ |
| 64 | + r->reflected_wave = r->source_voltage; |
| 65 | + return r->reflected_wave; |
| 66 | +} |
| 67 | +float tWDFresistiveSource_getVoltage(tWDFresistiveSource* const r) |
| 68 | +{ |
| 69 | + return ((r->incident_wave * 0.5f) + (r->reflected_wave * 0.5f)); |
| 70 | +} |
| 71 | +float tWDFresistiveSource_getCurrent(tWDFresistiveSource* const r) |
| 72 | +{ |
| 73 | + return (((r->incident_wave * 0.5f) - (r->reflected_wave * 0.5f)) * r->port_conductance); |
| 74 | +} |
| 75 | +void tWDFresistiveSource_setSourceVoltage(tWDFresistiveSource* const r, float source_voltage) |
| 76 | +{ |
| 77 | + r->source_voltage = source_voltage; |
| 78 | +} |
| 79 | + |
| 80 | + |
| 81 | +//WDF capacitor |
| 82 | + |
| 83 | +void tWDFcapacitor_init(tWDFcapacitor* const r, float electrical_capacitance, float sample_rate) |
| 84 | +{ |
| 85 | + r->port_resistance = 1.0f / (sample_rate * electrical_capacitance); //based on trapezoidal discretization |
| 86 | + r->port_conductance = (1.0f / r->port_resistance); |
| 87 | + r->electrical_capacitance = electrical_capacitance; |
| 88 | + r->incident_wave = 0.0f; |
| 89 | + r->reflected_wave = 0.0f; |
| 90 | + r->sample_rate = sample_rate; |
| 91 | + r->memory = 0.0f; |
| 92 | +} |
| 93 | +float tWDFcapacitor_getPortResistance(tWDFcapacitor* const r) |
| 94 | +{ |
| 95 | + return r->port_resistance; |
| 96 | +} |
| 97 | +void tWDFcapacitor_setIncidentWave(tWDFcapacitor* const r, float incident_wave) |
| 98 | +{ |
| 99 | + r->incident_wave = incident_wave; |
| 100 | + r->memory = r->incident_wave; |
| 101 | +} |
| 102 | +float tWDFcapacitor_getReflectedWave(tWDFcapacitor* const r) |
| 103 | +{ |
| 104 | + r->reflected_wave = r->memory; |
| 105 | + return r->reflected_wave; |
| 106 | +} |
| 107 | +float tWDFcapacitor_getVoltage(tWDFcapacitor* const r) |
| 108 | +{ |
| 109 | + return ((r->incident_wave * 0.5f) + (r->reflected_wave * 0.5f)); |
| 110 | +} |
| 111 | +float tWDFcapacitor_getCurrent(tWDFcapacitor* const r) |
| 112 | +{ |
| 113 | + return (((r->incident_wave * 0.5f) - (r->reflected_wave * 0.5f)) * r->port_conductance); |
| 114 | +} |
| 115 | + |
| 116 | + |
| 117 | +// WDF series |
| 118 | +void tWDFseriesAdaptor_init(tWDFseriesAdaptor* const r, tWDFresistor* const rL, tWDFcapacitor* const rR) |
| 119 | +{ |
| 120 | + r->rL = rL; |
| 121 | + r->rR = rR; |
| 122 | + r->port_resistance_left = tWDFresistor_getPortResistance(rL); |
| 123 | + r->port_resistance_right = tWDFcapacitor_getPortResistance(rR); |
| 124 | + r->port_resistance_up = r->port_resistance_left + r->port_resistance_right; |
| 125 | + r->port_conductance_up = 1.0f / r->port_resistance_up; |
| 126 | + r->port_conductance_left = 1.0f / r->port_resistance_left; |
| 127 | + r->port_conductance_right = 1.0f / r->port_resistance_right; |
| 128 | + r->incident_wave_up = 0.0f; |
| 129 | + r->incident_wave_left = 0.0f; |
| 130 | + r->incident_wave_right = 0.0f; |
| 131 | + r->reflected_wave_up = 0.0f; |
| 132 | + r->reflected_wave_left = 0.0f; |
| 133 | + r->reflected_wave_right = 0.0f; |
| 134 | + |
| 135 | + r->gamma_zero = 1.0f / (r->port_resistance_right + r->port_resistance_left); |
| 136 | +} |
| 137 | +float tWDFseriesAdaptor_getPortResistance(tWDFseriesAdaptor* const r) |
| 138 | +{ |
| 139 | + return r->port_resistance_up; |
| 140 | +} |
| 141 | +void tWDFseriesAdaptor_setIncidentWaves(tWDFseriesAdaptor* const r, float incident_wave) |
| 142 | +{ |
| 143 | + float gamma_left = r->port_resistance_left * r->gamma_zero; |
| 144 | + float gamma_right = r->port_resistance_right * r->gamma_zero; |
| 145 | + tWDFresistor_setIncidentWave(r->rL, (-1.0f * gamma_left * incident_wave) + ((1.0f - gamma_left) * tWDFresistor_getReflectedWave(r->rL)) - (gamma_left * tWDFcapacitor_getReflectedWave(r->rR))); |
| 146 | + tWDFcapacitor_setIncidentWave(r->rR, (-1.0f * gamma_right * incident_wave) + ((-1.0f * gamma_right) * tWDFresistor_getReflectedWave(r->rL)) + (1.0f - gamma_right * tWDFcapacitor_getReflectedWave(r->rR))); |
| 147 | +} |
| 148 | + |
| 149 | +float tWDFseriesAdaptor_getReflectedWave(tWDFseriesAdaptor* const r) |
| 150 | +{ |
| 151 | + return (-1.0f * (tWDFresistor_getReflectedWave(r->rL) + tWDFcapacitor_getReflectedWave(r->rR))); |
| 152 | +} |
| 153 | +float tWDFseriesAdaptor_getVoltage(tWDFseriesAdaptor* const r) |
| 154 | +{ |
| 155 | + return ((r->incident_wave_up * 0.5f) + (r->reflected_wave_up * 0.5f)); |
| 156 | +} |
| 157 | +float tWDFseriesAdaptor_getCurrent(tWDFseriesAdaptor* const r) |
| 158 | +{ |
| 159 | + return (((r->incident_wave_up * 0.5f) - (r->reflected_wave_up * 0.5f)) * r->port_conductance_up); |
| 32 | 160 | } |