Compare commits
2 commits
19cefe3563
...
3fabeb9559
Author | SHA1 | Date | |
---|---|---|---|
3fabeb9559 | |||
c5892bacc9 |
1 changed files with 4 additions and 3 deletions
|
@ -658,7 +658,6 @@ void Tasks::StartRobotTaskWithWatchdog(void *arg) {
|
|||
int killBatteryOk=0;
|
||||
int cpt=1;
|
||||
Message * msgSend;
|
||||
int err;
|
||||
|
||||
while(1){
|
||||
|
||||
|
@ -697,11 +696,13 @@ void Tasks::StartRobotTaskWithWatchdog(void *arg) {
|
|||
while (killBatteryOk==0) {
|
||||
cpt++;
|
||||
if(cpt==2){
|
||||
rt_mutex_acquire(&mutex_robot, TM_INFINITE);
|
||||
robot.Write(robot.ReloadWD());
|
||||
rt_mutex_release(&mutex_robot);
|
||||
cpt=0;
|
||||
}
|
||||
rt_task_wait_period(NULL);
|
||||
rt_sem_v(&sem_askBattery);
|
||||
|
||||
rt_mutex_acquire(&mutex_killBattery, TM_INFINITE);
|
||||
killBatteryOk=killBattery;
|
||||
rt_mutex_release(&mutex_killBattery);
|
||||
|
@ -726,7 +727,7 @@ void Tasks::MoveTask(void *arg) {
|
|||
/**************************************************************************************/
|
||||
/* The task starts here */
|
||||
/**************************************************************************************/
|
||||
rt_task_set_periodic(NULL, TM_NOW, 1000000000);
|
||||
rt_task_set_periodic(NULL, TM_NOW, 100000000);
|
||||
|
||||
while (1) {
|
||||
rt_task_wait_period(NULL);
|
||||
|
|
Loading…
Reference in a new issue