reimplement autons
- this is to be rewritten since the creation of the motorized intake
This commit is contained in:
parent
de8221fa33
commit
244afea916
7
CLOUDS/include/autons.hpp
Normal file
7
CLOUDS/include/autons.hpp
Normal 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
109
CLOUDS/src/autons.cpp
Normal 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();
|
||||
}
|
||||
Loading…
x
Reference in New Issue
Block a user