Advertisement
Guest User

Untitled

a guest
Nov 21st, 2019
126
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.70 KB | None | 0 0
  1. int LeftTrack = abs(pad_y) * 10;
  2. int RightTrack = abs(pad_y) * 10;
  3. int k = 1;  // some turning intensity koef
  4.  
  5. if (pad_x < 0 || pad_y == 0) {
  6.   LeftTrack = LeftTrack + k * pad_x * 10;
  7. }
  8.  
  9. if (pad_x > 0 || pad_y == 0) {
  10.   RightTrack = RightTrack - k * pad_x * 10;
  11. }
  12.  
  13. if (pad_y < 0) {
  14.   LeftTrack = LeftTrack * (-1);
  15.   RightTrack = RightTrack * (-1);
  16. }
  17.  
  18. // Left driver
  19. SoftPWMSetPercent(MotA1, LeftTrack > 0 ? LeftTrack : 0);    // move forward
  20. SoftPWMSetPercent(MotA2, LeftTrack < 0 ? abs(LeftTrack) : 0);  // move backward
  21.  
  22. // right driver
  23. SoftPWMSetPercent(MotB1, RightTrack > 0 ? RightTrack : 0);  // move forward
  24. SoftPWMSetPercent(MotB2, RightTrack < 0 ? abs(RightTrack) : 0);  // move backward
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement