commander remove orb_exists telemetry check

This commit is contained in:
Daniel Agar
2017-08-20 17:53:46 -04:00
committed by Lorenz Meier
parent 52ba62d6c4
commit 4b97e15714
+2 -4
View File
@@ -1975,16 +1975,14 @@ int commander_thread_main(int argc, char *argv[])
for (int i = 0; i < ORB_MULTI_MAX_INSTANCES; i++) {
if (telemetry_subs[i] < 0 && (OK == orb_exists(ORB_ID(telemetry_status), i))) {
if (telemetry_subs[i] < 0) {
telemetry_subs[i] = orb_subscribe_multi(ORB_ID(telemetry_status), i);
}
orb_check(telemetry_subs[i], &updated);
if (updated) {
struct telemetry_status_s telemetry;
memset(&telemetry, 0, sizeof(telemetry));
telemetry_status_s telemetry = {};
orb_copy(ORB_ID(telemetry_status), telemetry_subs[i], &telemetry);
/* perform system checks when new telemetry link connected */