38
modifications
Modifications
→movementTask
Les taches que le robot pourra effectuer Pour l’instant il n y en a qu’une seul : movement-Task.c
Les taches que le robot pourra effectuer Pour l’instant il n y en a qu’une seul : movement-Task.c
#include "movementTask.h"
#include "rbtMovement.h"
#include "MCP233.h"
/* Variables */
robotState_t robotState = BLOCKED;
/* Task */
void StartSendMovementCmd(void const * argument){
/******** Initializations ********/
//TODO measure accurately
rbtMovementInit(265, 88, 88, 4096, 4096);
drive_forward(0); //making sure that the MCP command buffer is empty
robotState = IDLE;
/******** Movement path command list ********/
/*Aller retour x2*/
rbtMove(1000); //distance en mm
rbt_turn(180); //angle en degres, (-) pour tourner a gauche et (+) pour tourner a droite
rbtMove(1000);
rbt_turn(180);
while(1){
osDelay(1); //boucle pour debugger, le programme devrait rester bloquer ici a la fin de son execution
}
/* USER CODE END 5 */
}