rewrite the autonomous
This commit is contained in:
parent
9acf49bddf
commit
f911e0975a
@ -8,6 +8,40 @@ using namespace globals;
|
|||||||
using namespace superstruct;
|
using namespace superstruct;
|
||||||
|
|
||||||
void test_auton() {
|
void test_auton() {
|
||||||
|
driveChassis(107, true);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
driveChassis(-38, true);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
turnChassis(-99);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
driveChassis(95, true);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
driveChassis(-10, true);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
turnChassis(15);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
driveChassis(40, true);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
leftSwing(60);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
driveChassis(-48, true);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
turnChassis(-90);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
driveChassis(12, true);
|
||||||
|
chassis.wait_drive();
|
||||||
|
|
||||||
|
// chassis.set_drive_pid(2, DRIVE_SPEED, false, true);
|
||||||
|
// chassis.wait_drive();
|
||||||
}
|
}
|
||||||
//pros::task_t intakeTask(run_intake_for, (void*) malloc(sizeof(double)), TASK_PRIORITY_DEFAULT, TASK_STACK_DEPTH_DEFAULT, "runIntakeFor");
|
//pros::task_t intakeTask(run_intake_for, (void*) malloc(sizeof(double)), TASK_PRIORITY_DEFAULT, TASK_STACK_DEPTH_DEFAULT, "runIntakeFor");
|
||||||
|
|||||||
Loading…
x
Reference in New Issue
Block a user