Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

AP_Math: Chirp: add complete method to see if chirp is finished

This commit is contained in:
Iampete1 2023-04-30 13:27:37 +01:00 committed by Andrew Tridgell
parent 8a4b30ec3f
commit ff4b63f9dc
2 changed files with 11 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libraries/AP_Math/chirp.cpp
View File

@ -46,6 +46,8 @@ void Chirp::init(float time_record, float frequency_start_hz, float frequency_st
B = logf(wMax / wMin); B = logf(wMax / wMin);
// Mark as incomplete
complete = false;
} }
// determine chirp signal output at the specified time and amplitude // determine chirp signal output at the specified time and amplitude
@ -83,5 +85,8 @@ float Chirp::update(float time, float waveform_magnitude)
waveform_freq_rads = wMax; waveform_freq_rads = wMax;
output = 0.0f; output = 0.0f;
} }
complete = time > record;
return output; return output;
} }

6
libraries/AP_Math/chirp.h
View File

@ -16,6 +16,9 @@ public:
// accessor for the current waveform frequency // accessor for the current waveform frequency
float get_frequency_rads() {return waveform_freq_rads; } float get_frequency_rads() {return waveform_freq_rads; }
// Return true if chirp is completed
bool completed() const { return complete; }
private: private:
// Total chirp length in seconds // Total chirp length in seconds
float record; float record;
@ -50,4 +53,7 @@ private:
// output of chirp signal at the requested time // output of chirp signal at the requested time
float output; float output;
// True if chirp is complete, reset to false on init
bool complete;
}; };