mirror of
https://github.com/team2059/Zaphod
synced 2024-12-18 20:12:28 -05:00
42 lines
669 B
C++
42 lines
669 B
C++
#include "Collector.h"
|
|
|
|
ZaphodCollector::ZaphodCollector()
|
|
{
|
|
collectorMotor = new Jaguar(COLLECTOR_SIDECAR, COLLECTOR_MOTOR);
|
|
}
|
|
|
|
void ZaphodCollector::updateCollector(bool shooting, float angle)
|
|
{
|
|
//Needed for the auto running of collector when shooting
|
|
if(shooting)
|
|
{
|
|
if(angle <= 40)
|
|
{
|
|
collectBall();
|
|
}
|
|
}
|
|
//
|
|
if(e_CollectorState == COLLECTING)
|
|
{
|
|
collectBall();
|
|
}
|
|
if(e_CollectorState == RELEASE)
|
|
{
|
|
releaseBall();
|
|
}
|
|
if(e_CollectorState == STOP)
|
|
{
|
|
collectorMotor->Set(0);
|
|
}
|
|
}
|
|
|
|
void ZaphodCollector::collectBall()
|
|
{
|
|
collectorMotor->Set(1);
|
|
}
|
|
|
|
void ZaphodCollector::releaseBall()
|
|
{
|
|
collectorMotor->Set(255);
|
|
}
|