Advertisement
Trainlover08

My first pros

Apr 5th, 2024 (edited)
105
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.11 KB | None | 0 0
  1. #import <stdio>
  2. #import <vector>
  3. #import <math.h>
  4. #import <string>
  5.  
  6.  
  7. pros::Motor motor1 (1);
  8. pros::Motor motor2 (2);
  9. pros::Motor motor3 (3);
  10. pros::Motor motor4 (4);
  11. pros::Motor motor5 (5);
  12. pros::Motor motor6 (6);
  13. std::vector<char> PORTS_LEFT = (1, 2, 3);
  14. std::vector<char> PORTS_RIGHT = (4, 5, 6);
  15. pros::Motor_Group motor_group_left (PORTS_LEFT);
  16. pros::Motor_Group motor_group_right (POSTS_RIGHT);
  17. pros::Controller master (E_CONTROLLER_MASTER);
  18.  
  19. float left_Drive;
  20. float right_Drive;
  21.  
  22. void motorCurve(const char joystick_position){
  23.     if(joystick_position > -5 && joystick_position < 5){
  24.         return 0;
  25.     } else {
  26.         return -((50 * (log(-joystick_position + 100))) - 100);
  27.     }
  28. }
  29.  
  30. int main(){
  31.     while(true){
  32.         left_Drive = motorCurve(pros::master.get_analog(E_CONTROLLER_LEFT_Y) - pros::master.get_analog(E_CONTROLLER_RIGHT_X));
  33.         right_Drive = motorCurve(pros::master.get_analog(E_CONTROLLER_LEFT_Y) + pros::master.get_analog(E_CONTROLLER_RIGHT_X));
  34.         motor_group_left.move_velocity(left_Drive);
  35.         motor_group_right.move_velocity(right_Drive);
  36.        
  37.         pros::delay(5);
  38.     }
  39. }
  40.  
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement