|
|
|
@ -100,7 +100,8 @@ void setup() {
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void loop() {
|
|
|
|
void loop() {
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
int startSleep = millis();
|
|
|
|
loop_count++;
|
|
|
|
loop_count++;
|
|
|
|
|
|
|
|
|
|
|
|
if (sim_mode == TRUE)
|
|
|
|
if (sim_mode == TRUE)
|
|
|
|
@ -130,6 +131,8 @@ void loop() {
|
|
|
|
// send telemetry
|
|
|
|
// send telemetry
|
|
|
|
|
|
|
|
|
|
|
|
// delay some time
|
|
|
|
// delay some time
|
|
|
|
|
|
|
|
Serial.print("Loop time: ");
|
|
|
|
|
|
|
|
Serial.println(millis() - startSleep);
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
@ -2217,7 +2220,7 @@ void pwm_interrupt_handler() {
|
|
|
|
// Serial.println(wav_position);
|
|
|
|
// Serial.println(wav_position);
|
|
|
|
if (wav_position++ > BUFFER_SIZE) { // 300) {
|
|
|
|
if (wav_position++ > BUFFER_SIZE) { // 300) {
|
|
|
|
wav_position = wav_position - BUFFER_SIZE;
|
|
|
|
wav_position = wav_position - BUFFER_SIZE;
|
|
|
|
// Serial.println("Reset wav_position");
|
|
|
|
Serial.println("Reset wav_position");
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|