Advertisement
Guest User

VCS/RMS cubic

a guest
Oct 29th, 2018
1,204
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.11 KB | None | 0 0
  1. int main(void) {
  2. vex::brain Brain;
  3. vex::motor left1(vex::PORT1, vex::gearSetting::ratio18_1, false);
  4. vex::motor left2(vex::PORT2, vex::gearSetting::ratio18_1, false);
  5. vex::motor right1(vex::PORT3, vex::gearSetting::ratio18_1, true);
  6. vex::motor right2(vex::PORT4, vex::gearSetting::ratio18_1, true);
  7.  
  8. vex::controller con(vex::controllerType::primary);
  9. while(true){
  10. float max = 127.0;
  11. float left_percent = con.Axis1.value()/max;
  12. float right_percent = con.Axis3.value()/max;
  13.  
  14. float left_new_percent = left_percent * left_percent * left_percent;
  15. float right_new_percent = right_percent * right_percent * right_percent;
  16.  
  17. float motor_max = 100;
  18. int left_power = left_new_percent * motor_max;
  19. int right_power = right_new_percent * motor_max;
  20.  
  21. left1.spin(fwd,left_power,vex::velocityUnits::pct);
  22. left2.spin(fwd,left_power,vex::velocityUnits::pct);
  23. right1.spin(fwd,right_power,vex::velocityUnits::pct);
  24. right2.spin(fwd,right_power,vex::velocityUnits::pct);
  25.  
  26. }
  27. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement