2015-01-11 16:02:49 -05:00
|
|
|
#ifndef COLLECTOR_H
|
|
|
|
#define COLLECTOR_H
|
|
|
|
|
|
|
|
#include "WPILib.h"
|
2015-03-02 08:28:03 -05:00
|
|
|
/**
|
|
|
|
* @brief Collects totes
|
|
|
|
*
|
|
|
|
* Uses four motors, two on the sides, one on the bottom, and one on the ramp to collect and eject totes
|
|
|
|
*/
|
2015-01-11 16:02:49 -05:00
|
|
|
class Collector: public Subsystem
|
|
|
|
{
|
2015-01-16 20:12:48 -05:00
|
|
|
private:
|
2015-03-02 08:28:03 -05:00
|
|
|
CANTalon *collectorMotorLeft, //<! Left collector motor
|
|
|
|
*collectorMotorBottom, //<! Bottom collctor motor
|
|
|
|
*collectorMotorRamp, //<! Ramp collctor motor
|
|
|
|
*collectorMotorRight; //<! Right collector motor
|
|
|
|
/**
|
|
|
|
* @brief Analog input for sonar (UNUSED)
|
|
|
|
*/
|
2015-02-15 07:53:19 -05:00
|
|
|
AnalogInput *sonarAnalog;
|
2015-03-02 08:28:03 -05:00
|
|
|
/**
|
|
|
|
* @brief Digital output for sonar (UNUSED)
|
|
|
|
*/
|
2015-02-15 07:53:19 -05:00
|
|
|
DigitalOutput *sonarDigital;
|
2015-01-16 20:12:48 -05:00
|
|
|
public:
|
2015-03-02 08:28:03 -05:00
|
|
|
/**
|
|
|
|
* @brief Constructs Collector
|
|
|
|
*/
|
2015-01-16 20:12:48 -05:00
|
|
|
Collector();
|
2015-03-02 08:28:03 -05:00
|
|
|
/**
|
|
|
|
* @brief No action
|
|
|
|
*/
|
2015-01-16 20:12:48 -05:00
|
|
|
void InitDefaultCommand();
|
2015-03-02 08:28:03 -05:00
|
|
|
/**
|
|
|
|
* @brief Moves the collectors
|
|
|
|
*
|
|
|
|
* @param double The speed to run the collectors
|
|
|
|
*/
|
2015-02-04 20:57:33 -05:00
|
|
|
void MoveRollers(double);
|
2015-03-02 08:28:03 -05:00
|
|
|
/**
|
|
|
|
* @brief Gets the distance of the sonar (UNUSED)
|
|
|
|
*
|
|
|
|
* @return The sonar distance
|
|
|
|
*/
|
2015-02-15 17:10:20 -05:00
|
|
|
double GetSonarDistance();
|
2015-01-11 16:02:49 -05:00
|
|
|
};
|
|
|
|
#endif
|
2015-02-08 12:26:15 -05:00
|
|
|
// vim: ts=2:sw=2:et
|