Guest User

Untitled

a guest
Nov 23rd, 2017
76
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.90 KB | None | 0 0
  1. #define LEFT_LIMIT 100
  2. #define RIGHT_LIMIT 100
  3. #define ENGINE_SPEED 500
  4.  
  5. EndlessRotateMode_Start(MODULE_ENGINE1, -ENGINE_SPEED);
  6. EndlessRotateMode_Start(MODULE_ENGINE2, ENGINE_SPEED);
  7. EndlessRotateMode_Start(MODULE_ENGINE3, -ENGINE_SPEED);
  8. EndlessRotateMode_Start(MODULE_ENGINE4, ENGINE_SPEED);
  9.  
  10. while(1)
  11. {
  12.     if(getIR(MODULE_SENSORS, &leftSensor, &centerSensor, &rightSensor))
  13.     {
  14.         if(leftSensor > LEFT_LIMIT)
  15.         {
  16.             EndlessRotateMode_Stop(MODULE_ENGINE1);
  17.             EndlessRotateMode_Stop(MODULE_ENGINE3);
  18.         }
  19.         else if(rightSensor > RIGHT_LIMIT)
  20.         {
  21.             EndlessRotateMode_Stop(MODULE_ENGINE2);
  22.             EndlessRotateMode_Stop(MODULE_ENGINE4);
  23.         }
  24.         else
  25.         {
  26.             EndlessRotateMode_Start(MODULE_ENGINE1, -ENGINE_SPEED);
  27.             EndlessRotateMode_Start(MODULE_ENGINE2, ENGINE_SPEED);
  28.             EndlessRotateMode_Start(MODULE_ENGINE3, -ENGINE_SPEED);
  29.             EndlessRotateMode_Start(MODULE_ENGINE4, ENGINE_SPEED);
  30.         }
  31.     }
  32. }
Add Comment
Please, Sign In to add comment