disp: actuator_status status byte indication

diff --git a/src/robofsm/robot_orte.c b/src/robofsm/robot_orte.c
index f4688521a2df8905ea84813726147e29587251b0..d01752e9cb97108563aba7264794ae9470432460 100644 (file)
--- a/src/robofsm/robot_orte.c
+++ b/src/robofsm/robot_orte.c
@@ -239,20 +239,18 @@ void rcv_actuator_status_cb(const ORTERecvInfo *info, void *vinstance,
        switch (info->status) {
                case NEW_DATA:
                        if (robot.orte.actuator_status.status == 0) {
-                               //robot.hw_status[STATUS_ACTUATORS]=HW_STATUS_OK;
+                               robot.hw_status[STATUS_LFT]=HW_STATUS_OK;
                                //FIXME
                        } else {
-                               //robot.hw_status[STATUS_ACTUATORS]=HW_STATUS_WARNING;
+                               robot.hw_status[STATUS_LFT]=HW_STATUS_WARNING;
                                //FIXME
                        }
-                       // robot.orte.actuator_status.lift_pos
-                       // robot.orte.actuator_status.pusher_pos
                        //FSM_SIGNAL(ACT, STATUS_RCVD, NULL);
                        break;
                case DEADLINE:
-                       // robot.hw_status[STATUS_ACTUATORS]=HW_STATUS_FAILED;
+                       robot.hw_status[STATUS_LFT]=HW_STATUS_FAILED;
                        //FIXME
-                       DBG("ORTE deadline occurred - servos receive\n");
+                       DBG("ORTE deadline occurred - actuator_status receive\n");
                        break;
        }
 }