Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #import <stdio>
- #import <vector>
- #import <math.h>
- #import <string>
- pros::Motor motor1 (1);
- pros::Motor motor2 (2);
- pros::Motor motor3 (3);
- pros::Motor motor4 (4);
- pros::Motor motor5 (5);
- pros::Motor motor6 (6);
- std::vector<char> PORTS_LEFT = (1, 2, 3);
- std::vector<char> PORTS_RIGHT = (4, 5, 6);
- pros::Motor_Group motor_group_left (PORTS_LEFT);
- pros::Motor_Group motor_group_right (POSTS_RIGHT);
- pros::Controller master (E_CONTROLLER_MASTER);
- float left_Drive;
- float right_Drive;
- void motorCurve(const char joystick_position){
- if(joystick_position > -5 && joystick_position < 5){
- return 0;
- } else {
- return -((50 * (log(-joystick_position + 100))) - 100);
- }
- }
- int main(){
- while(true){
- left_Drive = motorCurve(pros::master.get_analog(E_CONTROLLER_LEFT_Y) - pros::master.get_analog(E_CONTROLLER_RIGHT_X));
- right_Drive = motorCurve(pros::master.get_analog(E_CONTROLLER_LEFT_Y) + pros::master.get_analog(E_CONTROLLER_RIGHT_X));
- motor_group_left.move_velocity(left_Drive);
- motor_group_right.move_velocity(right_Drive);
- pros::delay(5);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement