mirror of
https://github.com/team2059/Dent
synced 2025-01-07 22:14:14 -05:00
21 lines
683 B
C++
21 lines
683 B
C++
|
#include "HHRobot.h"
|
||
|
|
#include "HHBase.h"
|
||
|
|
HHRobot::HHRobot():
|
||
|
|
//
|
||
|
|
hhdrive(new RobotDrive(2,0,3,1)),
|
||
|
|
joystick1(new Extreme3dPro(0)){
|
||
|
|
hhdrive->SetExpiration(0.1);
|
||
|
|
hhdrive->SetInvertedMotor(RobotDrive::kFrontRightMotor, true);
|
||
|
|
hhdrive->SetInvertedMotor(RobotDrive::kRearLeftMotor,true);
|
||
|
|
}
|
||
|
|
void HHRobot::Init(){
|
||
|
|
printf("Initing\n");
|
||
|
|
printf("Code Version: %f\n",0000.1);
|
||
|
|
//Put table values initally to avoid annoying refreshing
|
||
|
|
}
|
||
|
|
//Main function used to handle periodic tasks on the robot
|
||
|
|
void HHRobot::Handler(){
|
||
|
|
hhdrive->MecanumDrive_Cartesian(joystick1->GetJoystickAxis("z"), joystick1->GetJoystickAxis("y"), joystick1->GetJoystickAxis("x"));
|
||
|
|
}
|
||
|
|
// vim: ts=2:sw=2:et
|