fmu: fix safety button

- use the orb topic safety to check the safety state, because the actual
  safety state can come from the IO
- fix initialization if circuit breaker is set
This commit is contained in:
Beat Küng
2018-08-02 15:48:35 +02:00
parent 4c572577b2
commit bc9c25a376
2 changed files with 45 additions and 24 deletions
+2 -1
View File
@@ -1650,7 +1650,8 @@ PX4IO::io_handle_status(uint16_t status)
orb_publish(ORB_ID(safety), _to_safety, &safety);
} else {
_to_safety = orb_advertise(ORB_ID(safety), &safety);
int instance;
_to_safety = orb_advertise_multi(ORB_ID(safety), &safety, &instance, ORB_PRIO_DEFAULT);
}
return ret;