Kill other processes on orte deadline

diff --git a/src/robofsm/robot_orte.c b/src/robofsm/robot_orte.c
index 9d885fd9454011a5abf09d804b68004db37b1d61..9ae31f50c1a29335d8e8e91c34396279a981e5b0 100644 (file)
--- a/src/robofsm/robot_orte.c
+++ b/src/robofsm/robot_orte.c
@@ -232,6 +232,7 @@ void rcv_hokuyo_scan_cb(const ORTERecvInfo *info, void *vinstance,
                }
                case DEADLINE:
                        robot.hw_status[STATUS_HOK] = HW_STATUS_FAILED;
+                       system("killall -9 hokuyo");
                        DBG("%s: ORTE deadline occurred\n", __FUNCTION__);
                        break;
        }
@@ -252,6 +253,8 @@ void rcv_camera_result_cb(const ORTERecvInfo *info, void *vinstance,
                }
                case DEADLINE:
                        robot.hw_status[STATUS_CAM] = HW_STATUS_FAILED;
+                       system("killall -9 rozpuk");
+
                        DBG("%s: ORTE deadline occurred\n", __FUNCTION__);
                        break;
        }