void taskUpdateSonar(void) { if (sensors(SENSOR_SONAR)) { rangefinderUpdate(); } //updatePositionEstimator_SonarTopic(currentTime); }
void taskUpdateSonar(timeUs_t currentTimeUs) { UNUSED(currentTimeUs); if (sensors(SENSOR_SONAR)) { rangefinderUpdate(); } //updatePositionEstimator_SonarTopic(currentTimeUs); }