mirror of
https://github.com/team2059/Dent
synced 2024-12-18 20:52:29 -05:00
Preparing for releaes v2.1
This commit is contained in:
parent
76e282b413
commit
3de6e0023c
@ -71,19 +71,19 @@ Autonomous::Autonomous(int seq){
|
||||
//TODO: Implement this
|
||||
break;
|
||||
case 7:
|
||||
// Same as auto 4 with (Three|Two) totes checked, collect bin, drive to Auto Zone (TM), release totes
|
||||
// Same as auto 4, then collect bin, drive to Auto Zone (TM), release totes
|
||||
//TODO: Implement this
|
||||
break;
|
||||
case 8:
|
||||
//Use rear elevator to move tote
|
||||
AddSequential(new Turn(1.8));
|
||||
AddSequential(new AutoDrive(2.3,0.0,-0.75));
|
||||
AddSequential(new AutoDrive(2.3, 0.0, -0.75));
|
||||
AddSequential(new Turn(1.8));
|
||||
break;
|
||||
case 9:
|
||||
//Use rear elevator to move bin
|
||||
AddSequential(new BinLower(.1));
|
||||
AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"),0.0,0.75));
|
||||
AddSequential(new BinLower(0.1));
|
||||
AddSequential(new AutoDrive(SmartDashboard::GetNumber("Auto Zone Distance"), 0.0, 0.75));
|
||||
AddSequential(new Turn(2.1));
|
||||
break;
|
||||
default:
|
||||
|
@ -19,6 +19,18 @@
|
||||
* Sequence 2: Collects a tote, turns, then drives to the auto zone
|
||||
*
|
||||
* Sequence 3: Collects two or three totes then drives to auto zone
|
||||
*
|
||||
* Sequence 4: Collect one, two, or three totes, drive to Auto Zone, release totes
|
||||
*
|
||||
* Sequence 5: Same as auto 4, but navigate around bins (not implemented)
|
||||
*
|
||||
* Sequence 6: Collect 1 bin and 1 tote (not implemented)
|
||||
*
|
||||
* Sequence 7: Same as auto 4, then collect bin, drive to auto zone, release totes (not implemented)
|
||||
*
|
||||
* Sequence 8: Use rear elevator to move tote
|
||||
*
|
||||
* Sequence 9: Use rear elevator to move bin
|
||||
*/
|
||||
class Autonomous: public CommandGroup{
|
||||
public:
|
||||
|
@ -5,7 +5,7 @@
|
||||
#include "WPILib.h"
|
||||
|
||||
/**
|
||||
* @brief Closes BinElevatorArms (NOT USED)
|
||||
* @brief Closes BinElevatorArms (unused)
|
||||
*
|
||||
* Sets the solenoid to close the arms of the BinElevator
|
||||
*/
|
||||
@ -40,6 +40,5 @@ class BinCloseArms: public Command{
|
||||
*/
|
||||
void Interrupted();
|
||||
};
|
||||
|
||||
#endif
|
||||
// vim: ts=2:sw=2:et
|
||||
|
@ -8,7 +8,6 @@
|
||||
* @brief Lowers the bin elevator until a timeout is reached
|
||||
*/
|
||||
class BinLower: public Command{
|
||||
private:
|
||||
public:
|
||||
/**
|
||||
* @brief Constructs BinLower
|
||||
|
@ -11,7 +11,7 @@
|
||||
*/
|
||||
class RollVar: public Command{
|
||||
private:
|
||||
double speed; //<! Speed control of the collector
|
||||
double speed; //<! Speed multiplier of the collector
|
||||
public:
|
||||
/**
|
||||
* @brief Constructs RollVar
|
||||
|
@ -72,12 +72,11 @@ void DentRobot::TeleopInit(){
|
||||
}
|
||||
void DentRobot::TeleopPeriodic(){
|
||||
Scheduler::GetInstance()->Run();
|
||||
//TODO: Calibrate 1.0 to the height we want the elevator to automatically raise
|
||||
if(elevator->GetUseEncoder()&&elevator->GetHeight()<=-1.0){
|
||||
// Raise the elevator if it dips below elevatorTop
|
||||
oi->raise->Start();
|
||||
}
|
||||
SmartDashboard::PutNumber("CollectorThrottle",oi->GetLeftThrottle());
|
||||
SmartDashboard::PutNumber("CollectorThrottle", oi->GetLeftThrottle());
|
||||
}
|
||||
void DentRobot::TestPeriodic(){
|
||||
}
|
||||
|
@ -13,7 +13,6 @@ void Drivetrain::InitDefaultCommand(){
|
||||
SetDefaultCommand(new Drive());
|
||||
}
|
||||
void Drivetrain::DriveMecanum(double x, double y, double z, double sensitivity, bool driveStraight){
|
||||
//TODO: Find the correct value for kP
|
||||
double kP=SmartDashboard::GetNumber("Gyro kP");
|
||||
double correctX = -(sensitivity*(pow(x, 3))+(1-sensitivity)*x);
|
||||
double correctY = -(sensitivity*(pow(y, 3))+(1-sensitivity)*y);
|
||||
|
Loading…
Reference in New Issue
Block a user