[wpilib] GenericHID: Add rumble both option (#4843)

This commit is contained in:
Sriman Achanta
2022-12-24 14:28:52 -05:00
committed by GitHub
parent 8aa9dbfa90
commit e84dbfede0
3 changed files with 31 additions and 19 deletions

View File

@@ -134,15 +134,17 @@ void GenericHID::SetOutputs(int value) {
}
void GenericHID::SetRumble(RumbleType type, double value) {
if (value < 0) {
value = 0;
} else if (value > 1) {
value = 1;
}
value = std::clamp(value, 0.0, 1.0);
double rumbleValue = value * 65535;
if (type == kLeftRumble) {
m_leftRumble = value * 65535;
m_leftRumble = rumbleValue;
} else if (type == kRightRumble) {
m_rightRumble = rumbleValue;
} else {
m_rightRumble = value * 65535;
m_leftRumble = rumbleValue;
m_rightRumble = rumbleValue;
}
HAL_SetJoystickOutputs(m_port, m_outputs, m_leftRumble, m_rightRumble);
}