mirror of
https://github.com/team2059/Zaphod
synced 2025-01-07 22:14:14 -05:00
made code changes
This commit is contained in:
parent
9e9ea1e6de
commit
6dbf8665a7
15
MyRobot.cpp
15
MyRobot.cpp
@ -1,7 +1,7 @@
|
|||||||
//Sonar code
|
//Sonar code
|
||||||
#include "WPILib.h"
|
#include "WPILib.h"
|
||||||
#include "SmartDashboard/SmartDashboard.h"
|
#include "SmartDashboard/SmartDashboard.h"
|
||||||
//#include "Command.h"
|
#include "Command.h"
|
||||||
#include <iostream>
|
#include <iostream>
|
||||||
#include <math.h>
|
#include <math.h>
|
||||||
#include <vector>
|
#include <vector>
|
||||||
@ -128,8 +128,6 @@ public:
|
|||||||
upLimit = 167;
|
upLimit = 167;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
void calcRobot(){
|
|
||||||
}
|
|
||||||
void shootRobot(float power=0, bool override=false) {
|
void shootRobot(float power=0, bool override=false) {
|
||||||
override=true;
|
override=true;
|
||||||
//Needs a limit to help the driver aim
|
//Needs a limit to help the driver aim
|
||||||
@ -324,15 +322,17 @@ public:
|
|||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
if(i<=initalDriveTime*200) {
|
if(i<=initalDriveTime*200) {
|
||||||
|
//Drive initialDriveTime amount of time
|
||||||
driveRobot(1.0f,0.0f);
|
driveRobot(1.0f,0.0f);
|
||||||
//setMotorValue(6, 1, 1);
|
|
||||||
} else if(i>shooterDelay&&i<shooterDelay+(shooterDuration*200)&&shooterMaxAngle>=potToDegrees(armPot.GetAverageVoltage())) {
|
} else if(i>shooterDelay&&i<shooterDelay+(shooterDuration*200)&&shooterMaxAngle>=potToDegrees(armPot.GetAverageVoltage())) {
|
||||||
driveRobot(0, 0);
|
//Shooting
|
||||||
shootRobot(1, true);
|
driveRobot(0.0f, 0.0f);
|
||||||
|
shootRobot(1.0f, true);
|
||||||
setMotorValue(6, 1, 1);
|
setMotorValue(6, 1, 1);
|
||||||
}
|
}
|
||||||
if(i>480&&i<430+initalDriveTime){
|
if(i>480&&i<430+initalDriveTime){
|
||||||
driveRobot(-1,0);
|
driveRobot(-1.0f,0.0f);
|
||||||
|
setMotorValue(6, 1, 0);
|
||||||
//TODO
|
//TODO
|
||||||
} else if(i>430+initalDriveTime/*&&ballLimit.Get()==1*/) {
|
} else if(i>430+initalDriveTime/*&&ballLimit.Get()==1*/) {
|
||||||
driveRobot(-0.6f,0.0f);
|
driveRobot(-0.6f,0.0f);
|
||||||
@ -340,6 +340,7 @@ public:
|
|||||||
//TODO
|
//TODO
|
||||||
} else if(/*ballLimit.Get()==1&&*/i>430+initalDriveTime) {
|
} else if(/*ballLimit.Get()==1&&*/i>430+initalDriveTime) {
|
||||||
driveRobot(1.0f,0.0f);
|
driveRobot(1.0f,0.0f);
|
||||||
|
setMotorValue(6, 1, 0);
|
||||||
}
|
}
|
||||||
if(i>480&&i<480){
|
if(i>480&&i<480){
|
||||||
shootRobot(0.25f,true);
|
shootRobot(0.25f,true);
|
||||||
|
Loading…
x
Reference in New Issue
Block a user