Sane code for the Demo
This commit is contained in:
parent
17bd06f9c2
commit
6b3bcbe38d
@ -1,13 +1,14 @@
|
|||||||
#include "WPILib.h"
|
#include "WPILib.h"
|
||||||
#include "Shooter.h"
|
#include "Shooter.h"
|
||||||
|
#include <math.h>
|
||||||
|
|
||||||
#ifndef BUTTON_LAYOUT
|
#ifndef BUTTON_LAYOUT
|
||||||
#define BUTTON_LAYOUT
|
#define BUTTON_LAYOUT
|
||||||
|
|
||||||
#define TRIGGER 1 // Trigger button number
|
#define TRIGGER 1 // Trigger button number
|
||||||
#define THUMB 2 // Thumb button number
|
#define THUMB 2 // Thumb button number
|
||||||
#define RAMP_RAISE 3 // Button 3 for Raising Ramp
|
#define RAMP_RAISE 5 // Button 3 for Raising Ramp
|
||||||
#define RAMP_LOWER 4 // Button 4 to lower ramp.
|
#define RAMP_LOWER 3 // Button 4 to lower ramp.
|
||||||
#define UNJAM 11
|
#define UNJAM 11
|
||||||
|
|
||||||
#define DEADZONE_RADIUS 0.01 // Deadzone Radius prevents tiny twitches in the joystick's value from
|
#define DEADZONE_RADIUS 0.01 // Deadzone Radius prevents tiny twitches in the joystick's value from
|
||||||
@ -63,8 +64,8 @@ private:
|
|||||||
SmartDashboard::PutData("Auto Modes", chooser);
|
SmartDashboard::PutData("Auto Modes", chooser);
|
||||||
shooter1.Enable();
|
shooter1.Enable();
|
||||||
shooter2.Enable();
|
shooter2.Enable();
|
||||||
left_drive.SetInverted(true);
|
//left_drive.SetInverted(true);
|
||||||
right_drive.SetInverted(true);
|
//right_drive.SetInverted(true);
|
||||||
//launch_spinny.SetInverted(true);
|
//launch_spinny.SetInverted(true);
|
||||||
inverting = false;
|
inverting = false;
|
||||||
pickupRunning = false;
|
pickupRunning = false;
|
||||||
@ -100,11 +101,7 @@ private:
|
|||||||
|
|
||||||
void AutonomousPeriodic()
|
void AutonomousPeriodic()
|
||||||
{
|
{
|
||||||
if(autoSelected == autoNameCustom){
|
|
||||||
//Custom Auto goes here
|
|
||||||
} else {
|
|
||||||
//Default Auto goes here
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void TeleopInit()
|
void TeleopInit()
|
||||||
@ -115,8 +112,7 @@ private:
|
|||||||
void TeleopPeriodic()
|
void TeleopPeriodic()
|
||||||
{
|
{
|
||||||
//std::cout << "Ramp position: "<< launch_spinny.GetEncPosition() << std::endl;
|
//std::cout << "Ramp position: "<< launch_spinny.GetEncPosition() << std::endl;
|
||||||
drive.ArcadeDrive(&driver_stick, true);
|
drive.ArcadeDrive(-driver_stick.GetY(), -driver_stick.GetX() * 0.75);
|
||||||
|
|
||||||
//bool rampDoing = false;
|
//bool rampDoing = false;
|
||||||
// This is shit code for testing. Replace it with real code.
|
// This is shit code for testing. Replace it with real code.
|
||||||
if(!ramping && operator_stick.GetRawButton(RAMP_RAISE))
|
if(!ramping && operator_stick.GetRawButton(RAMP_RAISE))
|
||||||
|
@ -64,12 +64,12 @@ public:
|
|||||||
|
|
||||||
void LowerRamp()
|
void LowerRamp()
|
||||||
{
|
{
|
||||||
launch_spinny->Set(-1);
|
launch_spinny->Set(-0.5);
|
||||||
}
|
}
|
||||||
|
|
||||||
void RaiseRamp()
|
void RaiseRamp()
|
||||||
{
|
{
|
||||||
launch_spinny->Set(1);
|
launch_spinny->Set(0.5);
|
||||||
}
|
}
|
||||||
|
|
||||||
void StopRamp()
|
void StopRamp()
|
||||||
|
Reference in New Issue
Block a user