Removed sync group from SpeedController interface (#51)

CANJaguar is the only motor controller using sync groups, so that feature doesn't belong in an interface used by all motor controllers. If teams want to use sync groups, they should cast to the appropriate motor controller type themselves.
This commit is contained in:
Tyler Veness
2016-05-23 20:42:58 -07:00
committed by Peter Johnson
parent e842ff7ad5
commit 9e99df1cf7
29 changed files with 87 additions and 273 deletions

View File

@@ -506,22 +506,14 @@ void RobotDrive::MecanumDrive_Cartesian(float x, float y, float rotation,
Normalize(wheelSpeeds);
uint8_t syncGroup = 0x80;
m_frontLeftMotor->Set(wheelSpeeds[kFrontLeftMotor] *
m_invertedMotors[kFrontLeftMotor] * m_maxOutput,
syncGroup);
m_invertedMotors[kFrontLeftMotor] * m_maxOutput);
m_frontRightMotor->Set(wheelSpeeds[kFrontRightMotor] *
m_invertedMotors[kFrontRightMotor] * m_maxOutput,
syncGroup);
m_invertedMotors[kFrontRightMotor] * m_maxOutput);
m_rearLeftMotor->Set(wheelSpeeds[kRearLeftMotor] *
m_invertedMotors[kRearLeftMotor] * m_maxOutput,
syncGroup);
m_invertedMotors[kRearLeftMotor] * m_maxOutput);
m_rearRightMotor->Set(wheelSpeeds[kRearRightMotor] *
m_invertedMotors[kRearRightMotor] * m_maxOutput,
syncGroup);
// CANJaguar::UpdateSyncGroup(syncGroup);
m_invertedMotors[kRearRightMotor] * m_maxOutput);
// FIXME: m_safetyHelper->Feed();
}
@@ -564,22 +556,14 @@ void RobotDrive::MecanumDrive_Polar(float magnitude, float direction,
Normalize(wheelSpeeds);
uint8_t syncGroup = 0x80;
m_frontLeftMotor->Set(wheelSpeeds[kFrontLeftMotor] *
m_invertedMotors[kFrontLeftMotor] * m_maxOutput,
syncGroup);
m_invertedMotors[kFrontLeftMotor] * m_maxOutput);
m_frontRightMotor->Set(wheelSpeeds[kFrontRightMotor] *
m_invertedMotors[kFrontRightMotor] * m_maxOutput,
syncGroup);
m_invertedMotors[kFrontRightMotor] * m_maxOutput);
m_rearLeftMotor->Set(wheelSpeeds[kRearLeftMotor] *
m_invertedMotors[kRearLeftMotor] * m_maxOutput,
syncGroup);
m_invertedMotors[kRearLeftMotor] * m_maxOutput);
m_rearRightMotor->Set(wheelSpeeds[kRearRightMotor] *
m_invertedMotors[kRearRightMotor] * m_maxOutput,
syncGroup);
// CANJaguar::UpdateSyncGroup(syncGroup);
m_invertedMotors[kRearRightMotor] * m_maxOutput);
// FIXME: m_safetyHelper->Feed();
}
@@ -614,25 +598,17 @@ void RobotDrive::HolonomicDrive(float magnitude, float direction,
void RobotDrive::SetLeftRightMotorOutputs(float leftOutput, float rightOutput) {
wpi_assert(m_rearLeftMotor != nullptr && m_rearRightMotor != nullptr);
uint8_t syncGroup = 0x80;
if (m_frontLeftMotor != nullptr)
m_frontLeftMotor->Set(
Limit(leftOutput) * m_invertedMotors[kFrontLeftMotor] * m_maxOutput,
syncGroup);
Limit(leftOutput) * m_invertedMotors[kFrontLeftMotor] * m_maxOutput);
m_rearLeftMotor->Set(
Limit(leftOutput) * m_invertedMotors[kRearLeftMotor] * m_maxOutput,
syncGroup);
Limit(leftOutput) * m_invertedMotors[kRearLeftMotor] * m_maxOutput);
if (m_frontRightMotor != nullptr)
m_frontRightMotor->Set(
-Limit(rightOutput) * m_invertedMotors[kFrontRightMotor] * m_maxOutput,
syncGroup);
-Limit(rightOutput) * m_invertedMotors[kFrontRightMotor] * m_maxOutput);
m_rearRightMotor->Set(
-Limit(rightOutput) * m_invertedMotors[kRearRightMotor] * m_maxOutput,
syncGroup);
// CANJaguar::UpdateSyncGroup(syncGroup);
-Limit(rightOutput) * m_invertedMotors[kRearRightMotor] * m_maxOutput);
// FIXME: m_safetyHelper->Feed();
}