Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-21 16:18:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_HAL_SITL: add vector addition function

Browse Source
This commit is contained in:
Andy Piper 2022-03-06 13:51:10 +01:00 committed by Andrew Tridgell
parent 884454cd88
commit 3199412bff
2 changed files with 8 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
libraries/AP_HAL_SITL/DSP.cpp
View File

@ -137,6 +137,13 @@ void DSP::vector_scale_float(const float* vin, float scale, float* vout, uint16_
}
}
void DSP::vector_add_float(const float* vin1, const float* vin2, float* vout, uint16_t len) const
{
for (uint16_t i = 0; i < len; i++) {
vout[i] = vin1[i] + vin2[i];
}
}
float DSP::vector_mean_float(const float* vin, uint16_t len) const
{
float mean_value = 0.0f;

1
libraries/AP_HAL_SITL/DSP.h
View File

@ -52,5 +52,6 @@ private:
void vector_max_float(const float* vin, uint16_t len, float* maxValue, uint16_t* maxIndex) const override;
void vector_scale_float(const float* vin, float scale, float* vout, uint16_t len) const override;
float vector_mean_float(const float* vin, uint16_t len) const override;
void vector_add_float(const float* vin1, const float* vin2, float* vout, uint16_t len) const override;
void calculate_fft(complexf* f, uint16_t length);
};