mirror of
https://github.com/team2059/Zaphod
synced 2024-12-18 20:12:28 -05:00
Code now compiles. Completed refactorign of HHBase and Compressor. Continuing with refactoring. (Untested)
This commit is contained in:
parent
9490e32ef6
commit
8478154307
@ -1,7 +1,7 @@
|
|||||||
#include "HHBase.h"
|
#include "HHBase.h"
|
||||||
|
|
||||||
ZaphodBase::HHBase():
|
HHBase::HHBase():
|
||||||
hHBot(new HHRobot()){
|
hHBot(new ZaphodRobot()){
|
||||||
printf("Done\n");
|
printf("Done\n");
|
||||||
}
|
}
|
||||||
void HHBase::RobotInit(){
|
void HHBase::RobotInit(){
|
||||||
|
@ -1,22 +1,21 @@
|
|||||||
#ifndef __HH_BASE_H__
|
#ifndef __HH_BASE_H__
|
||||||
#define __HH_BASE_H__
|
#define __HH_BASE_H__
|
||||||
#include <WPILib.h>
|
#include <WPILib.h>
|
||||||
#include "HHRobot.h"
|
#include "ZaphodRobot.h"
|
||||||
#include "Subsystems/Controller.h"
|
#include "Subsystems/Controller.h"
|
||||||
#include "Subsystems/Shooter.h"
|
#include "Subsystems/Shooter.h"
|
||||||
#include "Subsystems/Collector.h"
|
#include "Subsystems/Collector.h"
|
||||||
#include "Subsystems/Compressor.h"
|
#include "Subsystems/Compressor.h"
|
||||||
#include "Subsystems/Dashboard.h"
|
#include "Subsystems/Dashboard.h"
|
||||||
//Because this is the first header to be included, classes need to be declared here
|
//Because this is the first header to be included, classes need to be declared here
|
||||||
class HHRobot;
|
class ZaphodRobot;
|
||||||
class HHShooter;
|
class HHShooter;
|
||||||
class HHCollector;
|
class HHCollector;
|
||||||
class HHCompressor;
|
class HHCompressor;
|
||||||
class JoystickController;
|
class JoystickController;
|
||||||
class ZaphodBase : public IterativeRobot
|
class HHBase : public IterativeRobot{
|
||||||
{
|
|
||||||
private:
|
private:
|
||||||
HHRobot* hHBot;
|
ZaphodRobot* hHBot;
|
||||||
public:
|
public:
|
||||||
HHBase();
|
HHBase();
|
||||||
void RobotInit();
|
void RobotInit();
|
||||||
|
@ -15,8 +15,8 @@ class HHCompressor
|
|||||||
}e_CollectorSolenoidState;
|
}e_CollectorSolenoidState;
|
||||||
HHCompressor();
|
HHCompressor();
|
||||||
void compressorSystemPeriodic();
|
void compressorSystemPeriodic();
|
||||||
void extendCollector();
|
void ExtendCollector();
|
||||||
void retractCollector();
|
void RetractCollector();
|
||||||
void startCompressing();
|
void StartCompressing();
|
||||||
void stopCompressing();
|
void StopCompressing();
|
||||||
};
|
};
|
||||||
|
@ -1,13 +1,11 @@
|
|||||||
#include "ZaphodRobot.h"
|
#include "ZaphodRobot.h"
|
||||||
#include "ZaphodBase.h"
|
#include "HHBase.h"
|
||||||
|
|
||||||
ZaphodRobot::ZaphodRobot():
|
ZaphodRobot::ZaphodRobot():
|
||||||
ControlSystem(new JoystickController()),
|
ControlSystem(new JoystickController()),
|
||||||
shooter(new ZaphodShooter()),
|
shooter(new ZaphodShooter()),
|
||||||
collector(new ZaphodCollector()),
|
collector(new ZaphodCollector()),
|
||||||
compressorSystem(new ZaphodCompressor()),
|
compressorSystem(new HHCompressor()),
|
||||||
dashboard(new ZaphodDashboard())
|
dashboard(new ZaphodDashboard()){
|
||||||
{
|
|
||||||
left1=new Jaguar(DRIVE_LEFT_SIDECAR, DRIVE_LEFT_MOTOR_ONE);
|
left1=new Jaguar(DRIVE_LEFT_SIDECAR, DRIVE_LEFT_MOTOR_ONE);
|
||||||
left2=new Jaguar(DRIVE_LEFT_SIDECAR, DRIVE_LEFT_MOTOR_TWO);
|
left2=new Jaguar(DRIVE_LEFT_SIDECAR, DRIVE_LEFT_MOTOR_TWO);
|
||||||
left3=new Jaguar(DRIVE_LEFT_SIDECAR, DRIVE_LEFT_MOTOR_THREE);
|
left3=new Jaguar(DRIVE_LEFT_SIDECAR, DRIVE_LEFT_MOTOR_THREE);
|
||||||
@ -23,11 +21,8 @@ ZaphodRobot::ZaphodRobot():
|
|||||||
rearSonarLeftA=new AnalogChannel(SONAR_REAR_LEFT_ANA);
|
rearSonarLeftA=new AnalogChannel(SONAR_REAR_LEFT_ANA);
|
||||||
rearSonarRightA=new AnalogChannel(SONAR_REAR_RIGHT_ANA);
|
rearSonarRightA=new AnalogChannel(SONAR_REAR_RIGHT_ANA);
|
||||||
}
|
}
|
||||||
|
|
||||||
//Functions to get sonar values and return as INCH values
|
//Functions to get sonar values and return as INCH values
|
||||||
|
float ZaphodRobot::getFrontSonar(){
|
||||||
float ZaphodRobot::getFrontSonar()
|
|
||||||
{
|
|
||||||
frontSonarLeftD->Set(1);
|
frontSonarLeftD->Set(1);
|
||||||
frontSonarLeftV=(frontSonarLeftA->GetAverageVoltage()/0.00488f)/2.54f;
|
frontSonarLeftV=(frontSonarLeftA->GetAverageVoltage()/0.00488f)/2.54f;
|
||||||
frontSonarLeftD->Set(0);
|
frontSonarLeftD->Set(0);
|
||||||
@ -38,9 +33,7 @@ float ZaphodRobot::getFrontSonar()
|
|||||||
//Returns the average (useful for throwing out useless readings)
|
//Returns the average (useful for throwing out useless readings)
|
||||||
return (frontSonarRightV+frontSonarLeftV)/2;
|
return (frontSonarRightV+frontSonarLeftV)/2;
|
||||||
}
|
}
|
||||||
|
float ZaphodRobot::getRearSonar(){
|
||||||
float ZaphodRobot::getRearSonar()
|
|
||||||
{
|
|
||||||
rearSonarLeftD->Set(1);
|
rearSonarLeftD->Set(1);
|
||||||
rearSonarLeftV=(rearSonarLeftA->GetAverageVoltage()/0.00488f)/2.54f;
|
rearSonarLeftV=(rearSonarLeftA->GetAverageVoltage()/0.00488f)/2.54f;
|
||||||
rearSonarLeftD->Set(0);
|
rearSonarLeftD->Set(0);
|
||||||
@ -51,9 +44,7 @@ float ZaphodRobot::getRearSonar()
|
|||||||
//Returns the average (useful for throwing out useless readings)
|
//Returns the average (useful for throwing out useless readings)
|
||||||
return (rearSonarRightV+rearSonarLeftV)/2;
|
return (rearSonarRightV+rearSonarLeftV)/2;
|
||||||
}
|
}
|
||||||
|
bool ZaphodRobot::checkJoystickValues(){
|
||||||
bool ZaphodRobot::checkJoystickValues()
|
|
||||||
{
|
|
||||||
float x=ControlSystem->rightJoystickAxisValues[1];
|
float x=ControlSystem->rightJoystickAxisValues[1];
|
||||||
float y=ControlSystem->rightJoystickAxisValues[2];
|
float y=ControlSystem->rightJoystickAxisValues[2];
|
||||||
if((-.1 < x && x < .1) && (-.1 < y && y < .1)) {
|
if((-.1 < x && x < .1) && (-.1 < y && y < .1)) {
|
||||||
@ -65,9 +56,7 @@ bool ZaphodRobot::checkJoystickValues()
|
|||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
void ZaphodRobot::driveRobot(float x, float y){
|
||||||
void ZaphodRobot::driveRobot(float x, float y)
|
|
||||||
{
|
|
||||||
if(y>1.0f) {
|
if(y>1.0f) {
|
||||||
y=1.0f;
|
y=1.0f;
|
||||||
} else if(y!=0.0f&&y<-1.0f) {
|
} else if(y!=0.0f&&y<-1.0f) {
|
||||||
@ -82,16 +71,11 @@ void ZaphodRobot::driveRobot(float x, float y)
|
|||||||
left2->SetRaw(int(leftPower));
|
left2->SetRaw(int(leftPower));
|
||||||
left3->SetRaw(int(leftPower));
|
left3->SetRaw(int(leftPower));
|
||||||
}
|
}
|
||||||
|
void ZaphodRobot::updateDashboard(){
|
||||||
void ZaphodRobot::updateDashboard()
|
|
||||||
{
|
|
||||||
dashboard->putFloatValue("Shooting Power", ControlSystem->throttle);
|
dashboard->putFloatValue("Shooting Power", ControlSystem->throttle);
|
||||||
}
|
}
|
||||||
|
|
||||||
//Main function used to handle periodic tasks on the robot
|
//Main function used to handle periodic tasks on the robot
|
||||||
|
void ZaphodRobot::handler(){
|
||||||
void ZaphodRobot::handler()
|
|
||||||
{
|
|
||||||
//Periodic tasks that should be run by every loop
|
//Periodic tasks that should be run by every loop
|
||||||
ControlSystem->updateJoysticks();
|
ControlSystem->updateJoysticks();
|
||||||
shooter->updateShooterPosition();
|
shooter->updateShooterPosition();
|
||||||
|
@ -1,19 +1,15 @@
|
|||||||
#ifndef __ZAPHOD_ROBOT_H__
|
#ifndef __ZAPHOD_ROBOT_H__
|
||||||
#define __ZAPHOD_ROBOT_H__
|
#define __ZAPHOD_ROBOT_H__
|
||||||
|
|
||||||
#include <WPILib.h>
|
#include <WPILib.h>
|
||||||
#include "ZaphodBase.h"
|
#include "HHBase.h"
|
||||||
#include "Definitions.h"
|
#include "Definitions.h"
|
||||||
|
|
||||||
class JoystickController;
|
class JoystickController;
|
||||||
class ZaphodShooter;
|
class ZaphodShooter;
|
||||||
class ZaphodCollector;
|
class ZaphodCollector;
|
||||||
class ZaphodCompressor;
|
class HHCompressor;
|
||||||
class ZaphodDashboard;
|
class ZaphodDashboard;
|
||||||
class ZaphodRobot;
|
class ZaphodRobot;
|
||||||
|
class ZaphodRobot{
|
||||||
class ZaphodRobot
|
|
||||||
{
|
|
||||||
private:
|
private:
|
||||||
Jaguar *right1, *right2, *right3, *left1, *left2, *left3;
|
Jaguar *right1, *right2, *right3, *left1, *left2, *left3;
|
||||||
DigitalOutput *frontSonarLeftD, *frontSonarRightD, *rearSonarLeftD, *rearSonarRightD;
|
DigitalOutput *frontSonarLeftD, *frontSonarRightD, *rearSonarLeftD, *rearSonarRightD;
|
||||||
@ -21,7 +17,7 @@ class ZaphodRobot
|
|||||||
JoystickController *ControlSystem;
|
JoystickController *ControlSystem;
|
||||||
ZaphodShooter *shooter;
|
ZaphodShooter *shooter;
|
||||||
ZaphodCollector *collector;
|
ZaphodCollector *collector;
|
||||||
ZaphodCompressor *compressorSystem;
|
HHCompressor *compressorSystem;
|
||||||
ZaphodDashboard *dashboard;
|
ZaphodDashboard *dashboard;
|
||||||
public:
|
public:
|
||||||
ZaphodRobot();
|
ZaphodRobot();
|
||||||
|
Loading…
Reference in New Issue
Block a user