2015-01-06 00:07:24 +00:00
|
|
|
#include "HHRobot.h"
|
|
|
|
|
#include "HHBase.h"
|
|
|
|
|
HHRobot::HHRobot():
|
2015-01-16 19:48:58 +00:00
|
|
|
DriveStick(new Extreme3dPro(0)),
|
|
|
|
|
//FrontRight,FrontLeft,RearRight,RearLeft
|
|
|
|
|
RobotDrive(new MecanumDrive(40,41,42,43)){
|
2015-01-06 00:07:24 +00:00
|
|
|
}
|
|
|
|
|
void HHRobot::Init(){
|
|
|
|
|
printf("Initing\n");
|
|
|
|
|
printf("Code Version: %f\n",0000.1);
|
|
|
|
|
}
|
|
|
|
|
//Main function used to handle periodic tasks on the robot
|
|
|
|
|
void HHRobot::Handler(){
|
2015-01-16 19:48:58 +00:00
|
|
|
RobotDrive->handler(DriveStick->GetJoystickAxis("x"),DriveStick->GetJoystickAxis("y"),DriveStick->GetJoystickAxis("z"),0);
|
2015-01-06 00:07:24 +00:00
|
|
|
}
|
|
|
|
|
// vim: ts=2:sw=2:et
|
