public static void changeControlMode(ControlMode mode) {
// Set control mode for the CAN Talon motor controllers
mecanumDriveControlsLeftFront.changeControlMode(mode);
mecanumDriveControlsLeftRear.changeControlMode(mode);
mecanumDriveControlsRightFront.changeControlMode(mode);
mecanumDriveControlsRightRear.changeControlMode(mode);
// Makes sure the Feedback Device is a Quad Encoder
mecanumDriveControlsLeftFront.setFeedbackDevice(CANTalon.FeedbackDevice.QuadEncoder);
mecanumDriveControlsLeftRear.setFeedbackDevice(CANTalon.FeedbackDevice.QuadEncoder);
mecanumDriveControlsRightFront.setFeedbackDevice(CANTalon.FeedbackDevice.QuadEncoder);
mecanumDriveControlsRightRear.setFeedbackDevice(CANTalon.FeedbackDevice.QuadEncoder);
// Sets PID Values for the Mecanum Drive Train
if (mode.equals(ControlMode.Speed)) {
mecanumDriveControlsLeftFront.setPID(1,0.002,1.0,0.0001,255,200,0);
mecanumDriveControlsLeftRear.setPID(1,0);
mecanumDriveControlsRightFront.setPID(1,0);
mecanumDriveControlsRightRear.setPID(1,0);
}
}
/**
* Turns the robot.
* @param left Whether to turn left (true),or right (false)
*/
public void turn(boolean left){
for (int i = 0; i < motors.size(); i++) {
RobotMap.changeControlMode(ControlMode.Speed);
if (left) {
robotDrive.mecanumDrive_Cartesian(0,-.5,0);
}
else {
robotDrive.mecanumDrive_Cartesian(0,.5,0);
}
}
}
版权声明:本文内容由互联网用户自发贡献,该文观点与技术仅代表作者本人。本站仅提供信息存储空间服务,不拥有所有权,不承担相关法律责任。如发现本站有涉嫌侵权/违法违规的内容, 请发送邮件至 dio@foxmail.com 举报,一经查实,本站将立刻删除。