reimplement autons

- this is to be rewritten since the creation of the motorized intake
This commit is contained in:
ary 2023-12-01 09:19:47 -05:00
parent de8221fa33
commit 244afea916
2 changed files with 116 additions and 0 deletions

View File

@ -0,0 +1,7 @@
#pragma once
#include "main.h"
void near_side();
void far_side();
void skills();

109
CLOUDS/src/autons.cpp Normal file
View File

@ -0,0 +1,109 @@
#include "main.h"
#include <stdlib.h>
using namespace globals;
using namespace superstruct;
/*
To run when our robot is starting on the far side from our alliance zone
/
close to our alliance goal.
*/
void near_side() {
// Score the triball preload
// INTAKE PLACEHOLDER -> IN
driveSync(90, true);
turnSync(90);
// INTAKE PLACERHOLDER -> OUT
pros::delay(125);
driveSync(22, true);
driveSync(-19, true);
//Collect and score the back outer triball
turnSync(-118);
driveSync(50, true);
pros::delay(150);
// INTAKE PLACEHOLDER -> OUT
pros::delay(100);
driveSync(-28, true);
turnSync(75);
pros::delay(100);
// INTAKE PLACEHOLDER -> OUT
driveSync(35, true);
driveSync(-35, true);
//Gain control of third triball, use wings to score last one
turnSync(313);
driveSync(40, true);
pros::delay(400);
// INTAKE PLACEHOLDER -> IN
driveSync(-2, true);
setTurnScale(0.75);
turnSync(90);
// INTAKE PLACEHOLDER -> IN
wings.open();
driveSync(65, true);
wings.close();
driveSync(-20, true);
}
/*
To run when our robot is starting on the near side from our alliance zone
/
far from our alliance goal.
*/
void far_side() {
wings.open(); // Prepare for removal of match load triball
//toggleIntake(true); // Secure preload triball
// Drive forward to removal match load triball with wings, close wings immediately
driveSync(30, true);
wings.close();
//Score the preload
turnSync(40);
//toggleIntake(false);
driveSync(35, true);
driveSync(-10, true);
//Turn towards the elevation bar area
turnSync(135);
driveSync(90, true);
wings.open(); // Open our wings as they are being used to contact the bar
turnSync(120);
}
void skills() {
//toggleIntake(true);
driveSync(30, true);
//toggleIntake(false);
turnSync(45);
driveSync(35, true);
driveSync(-35, true);
turnSync(-60);
driveSync(10, true);
wings.open();
togglePto(true);
pros::delay(100);
timer.reset();
while (timer.getElapsedTimeMS() < 35000) {
motor_trb.move_voltage(-12000);
}
motor_trb.move_voltage(0); // i hate my life
togglePto(false);
wings.close();
driveSync(-35, true);
turnSync(10);
driveSync(-40, true);
turnSync(45);
driveSync(125, true);
//turnSync();
}