void on_telemetry_received() { char buf[200]; size_t const data_len = get_telemetry_receiver_buffer_length(); read_telemetry_data(buf,data_len); for (size_t i = 0; i < data_len; ++i){ parse_data(buf[i]); } }
void on_telemetry_received() { if ( m_mutex == NULL){ m_mutex = xSemaphoreCreateMutex(); } if (mutex_acquire_telemetry_string() != nullptr){ read_telemetry_data(m_telemetry_string,200); m_telemetry_string[199]= '\0'; telemetry_received_time = quan::stm32::millis(); mutex_release_telemetry_string(); static int count = 49; if (++count == 50){ count = 0; quan::stm32::complement<heartbeat_led_pin>(); } } }