Team2890/allwpilib
4
0
Fork 0
mirror of https://github.com/wpilibsuite/allwpilib synced 2026-07-03 03:01:44 +00:00
Code Issues Packages Projects Releases Wiki Activity

SCRIPT: wpiformat

Browse Source
This commit is contained in:
PJ Reiniger
2025-11-07 20:01:58 -05:00
committed by Peter Johnson
parent ae6bdc9d25
commit 2109161534
749 changed files with 5504 additions and 3936 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
wpilibc/src/main/native/cpp/ExpansionHub.cpp
View File

@@ -44,7 +44,7 @@ class ExpansionHub::DataStore {
std::shared_ptr<ExpansionHub::DataStore> ExpansionHub::GetForUsbId(int usbId) {
WPILIB_AssertMessage(usbId >= 0 && usbId < NumUsbPorts, "USB {} out of range",
usbId);
usbId);
std::scoped_lock lock{m_handleLock};
std::weak_ptr<DataStore>& weakStore = m_storeMap[usbId];
auto strongStore = weakStore.lock();

7
wpilibc/src/main/native/cpp/ExpansionHubMotor.cpp
View File

@@ -21,10 +21,11 @@ ExpansionHubMotor::ExpansionHubMotor(int usbId, int channel)
m_velocityPidConstants{usbId, channel, true},
m_positionPidConstants{usbId, channel, false} {
WPILIB_AssertMessage(channel >= 0 && channel < ExpansionHub::NumMotorPorts,
"ExHub Motor Channel {} out of range", channel);
"ExHub Motor Channel {} out of range", channel);
if (!m_hub.CheckAndReserveMotor(channel)) {
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channel {}", channel);
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channel {}",
channel);
}
m_hub.ReportUsage(fmt::format("ExHubServo[{}]", channel), "ExHubServo");
@@ -154,7 +155,7 @@ ExpansionHubPidConstants& ExpansionHubMotor::GetPositionPidConstants() {
void ExpansionHubMotor::Follow(const ExpansionHubMotor& leader) {
if (m_hub.GetUsbId() != leader.m_hub.GetUsbId()) {
throw WPILIB_MakeError(err::InvalidParameter,
"Cannot follow motor on different hub");
"Cannot follow motor on different hub");
}
m_modePublisher.Set(kFollowerMode);
m_setpointPublisher.Set(leader.m_channel);

9
wpilibc/src/main/native/cpp/ExpansionHubServo.cpp
View File

@@ -12,10 +12,11 @@ using namespace wpi;
ExpansionHubServo::ExpansionHubServo(int usbId, int channel)
: m_hub{usbId}, m_channel{channel} {
WPILIB_AssertMessage(channel >= 0 && channel < ExpansionHub::NumServoPorts,
"ExHub Servo Channel {} out of range", channel);
"ExHub Servo Channel {} out of range", channel);
if (!m_hub.CheckAndReserveServo(channel)) {
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channel {}", channel);
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channel {}",
channel);
}
m_hub.ReportUsage(fmt::format("ExHubServo[{}]", channel), "ExHubServo");
@@ -98,7 +99,7 @@ void ExpansionHubServo::SetPWMRange(wpi::units::microsecond_t minPwm,
wpi::units::microsecond_t maxPwm) {
if (maxPwm <= minPwm) {
throw WPILIB_MakeError(err::ParameterOutOfRange,
"Max PWM must be greater than Min PWM");
"Max PWM must be greater than Min PWM");
}
m_minPwm = minPwm;
m_maxPwm = maxPwm;
@@ -110,7 +111,7 @@ void ExpansionHubServo::SetAngleRange(wpi::units::degree_t minAngle,
wpi::units::degree_t maxAngle) {
if (maxAngle <= minAngle) {
throw WPILIB_MakeError(err::ParameterOutOfRange,
"Max angle must be greater than Min angle");
"Max angle must be greater than Min angle");
}
m_minServoAngle = minAngle;
m_maxServoAngle = maxAngle;

3
wpilibc/src/main/native/cpp/counter/Tachometer.cpp
View File

@@ -69,7 +69,8 @@ wpi::units::turns_per_second_t Tachometer::GetRevolutionsPerSecond() const {
return wpi::units::turns_per_second_t{rotationHz.value()};
}
wpi::units::revolutions_per_minute_t Tachometer::GetRevolutionsPerMinute() const {
wpi::units::revolutions_per_minute_t Tachometer::GetRevolutionsPerMinute()
const {
return wpi::units::revolutions_per_minute_t{GetRevolutionsPerSecond()};
}

17
wpilibc/src/main/native/cpp/drive/MecanumDrive.cpp
View File

@@ -49,7 +49,8 @@ MecanumDrive::MecanumDrive(std::function<void(double)> frontLeftMotor,
}
void MecanumDrive::DriveCartesian(double xSpeed, double ySpeed,
double zRotation, wpi::math::Rotation2d gyroAngle) {
double zRotation,
wpi::math::Rotation2d gyroAngle) {
if (!reported) {
HAL_ReportUsage("RobotDrive", "MecanumCartesian");
reported = true;
@@ -99,17 +100,17 @@ void MecanumDrive::StopMotor() {
Feed();
}
MecanumDrive::WheelSpeeds MecanumDrive::DriveCartesianIK(double xSpeed,
double ySpeed,
double zRotation,
wpi::math::Rotation2d gyroAngle) {
MecanumDrive::WheelSpeeds MecanumDrive::DriveCartesianIK(
double xSpeed, double ySpeed, double zRotation,
wpi::math::Rotation2d gyroAngle) {
xSpeed = std::clamp(xSpeed, -1.0, 1.0);
ySpeed = std::clamp(ySpeed, -1.0, 1.0);
// Compensate for gyro angle.
auto input =
wpi::math::Translation2d{wpi::units::meter_t{xSpeed}, wpi::units::meter_t{ySpeed}}.RotateBy(
-gyroAngle);
auto input = wpi::math::Translation2d{
wpi::units::meter_t{xSpeed},
wpi::units::meter_t{
ySpeed}}.RotateBy(-gyroAngle);
double wheelSpeeds[4];
wheelSpeeds[kFrontLeft] = input.X().value() + input.Y().value() + zRotation;

36
wpilibc/src/main/native/cpp/driverstation/DriverStation.cpp
View File

@@ -45,10 +45,10 @@ namespace {
template <typename Topic>
class MatchDataSenderEntry {
public:
MatchDataSenderEntry(const std::shared_ptr<wpi::nt::NetworkTable>& table,
std::string_view key,
typename Topic::ParamType initialVal,
wpi::util::json topicProperties = wpi::util::json::object())
MatchDataSenderEntry(
const std::shared_ptr<wpi::nt::NetworkTable>& table, std::string_view key,
typename Topic::ParamType initialVal,
wpi::util::json topicProperties = wpi::util::json::object())
: publisher{Topic{table->GetTopic(key)}.PublishEx(Topic::kTypeString,
topicProperties)},
prevVal{initialVal} {
@@ -80,13 +80,17 @@ struct MatchDataSender {
MatchDataSenderEntry<wpi::nt::StringTopic> gameSpecificMessage{
table, "GameSpecificMessage", ""};
MatchDataSenderEntry<wpi::nt::StringTopic> eventName{table, "EventName", ""};
MatchDataSenderEntry<wpi::nt::IntegerTopic> matchNumber{table, "MatchNumber", 0};
MatchDataSenderEntry<wpi::nt::IntegerTopic> replayNumber{table, "ReplayNumber", 0};
MatchDataSenderEntry<wpi::nt::IntegerTopic> matchNumber{table, "MatchNumber",
0};
MatchDataSenderEntry<wpi::nt::IntegerTopic> replayNumber{table,
"ReplayNumber", 0};
MatchDataSenderEntry<wpi::nt::IntegerTopic> matchType{table, "MatchType", 0};
MatchDataSenderEntry<wpi::nt::BooleanTopic> alliance{table, "IsRedAlliance", true};
MatchDataSenderEntry<wpi::nt::IntegerTopic> station{table, "StationNumber", 1};
MatchDataSenderEntry<wpi::nt::IntegerTopic> controlWord{table, "FMSControlData",
0};
MatchDataSenderEntry<wpi::nt::BooleanTopic> alliance{table, "IsRedAlliance",
true};
MatchDataSenderEntry<wpi::nt::IntegerTopic> station{table, "StationNumber",
1};
MatchDataSenderEntry<wpi::nt::IntegerTopic> controlWord{table,
"FMSControlData", 0};
};
class JoystickLogSender {
@@ -206,7 +210,8 @@ bool DriverStation::GetStickButton(int stick, int button) {
return false;
}
if (button < 0 || button >= 64) {
WPILIB_ReportError(warn::BadJoystickIndex, "button {} out of range", button);
WPILIB_ReportError(warn::BadJoystickIndex, "button {} out of range",
button);
return false;
}
@@ -234,7 +239,8 @@ std::optional<bool> DriverStation::GetStickButtonIfAvailable(int stick,
return false;
}
if (button < 0 || button >= 64) {
WPILIB_ReportError(warn::BadJoystickIndex, "button {} out of range", button);
WPILIB_ReportError(warn::BadJoystickIndex, "button {} out of range",
button);
return false;
}
@@ -256,7 +262,8 @@ bool DriverStation::GetStickButtonPressed(int stick, int button) {
return false;
}
if (button < 0 || button >= 64) {
WPILIB_ReportError(warn::BadJoystickIndex, "button {} out of range", button);
WPILIB_ReportError(warn::BadJoystickIndex, "button {} out of range",
button);
return false;
}
@@ -289,7 +296,8 @@ bool DriverStation::GetStickButtonReleased(int stick, int button) {
return false;
}
if (button < 0 || button >= 64) {
WPILIB_ReportError(warn::BadJoystickIndex, "button {} out of range", button);
WPILIB_ReportError(warn::BadJoystickIndex, "button {} out of range",
button);
return false;
}

3
wpilibc/src/main/native/cpp/driverstation/GenericHID.cpp
View File

@@ -15,7 +15,8 @@ using namespace wpi;
GenericHID::GenericHID(int port) {
if (port < 0 || port >= DriverStation::kJoystickPorts) {
throw WPILIB_MakeError(warn::BadJoystickIndex, "port {} out of range", port);
throw WPILIB_MakeError(warn::BadJoystickIndex, "port {} out of range",
port);
}
m_port = port;
}

4
wpilibc/src/main/native/cpp/event/EventLoop.cpp
View File

@@ -25,7 +25,7 @@ EventLoop::EventLoop() {}
void EventLoop::Bind(wpi::util::unique_function<void()> action) {
if (m_running) {
throw WPILIB_MakeError(err::Error,
"Cannot bind EventLoop while it is running");
"Cannot bind EventLoop while it is running");
}
m_bindings.emplace_back(std::move(action));
}
@@ -40,7 +40,7 @@ void EventLoop::Poll() {
void EventLoop::Clear() {
if (m_running) {
throw WPILIB_MakeError(err::Error,
"Cannot clear EventLoop while it is running");
"Cannot clear EventLoop while it is running");
}
m_bindings.clear();
}

6
wpilibc/src/main/native/cpp/hardware/accelerometer/ADXL345_I2C.cpp
View File

@@ -15,9 +15,9 @@ ADXL345_I2C::ADXL345_I2C(I2C::Port port, Range range, int deviceAddress)
: m_i2c(port, deviceAddress),
m_simDevice("Accel:ADXL345_I2C", port, deviceAddress) {
if (m_simDevice) {
m_simRange = m_simDevice.CreateEnumDouble("range", wpi::hal::SimDevice::kOutput,
{"2G", "4G", "8G", "16G"},
{2.0, 4.0, 8.0, 16.0}, 0);
m_simRange = m_simDevice.CreateEnumDouble(
"range", wpi::hal::SimDevice::kOutput, {"2G", "4G", "8G", "16G"},
{2.0, 4.0, 8.0, 16.0}, 0);
m_simX = m_simDevice.CreateDouble("x", wpi::hal::SimDevice::kInput, 0.0);
m_simY = m_simDevice.CreateDouble("y", wpi::hal::SimDevice::kInput, 0.0);
m_simZ = m_simDevice.CreateDouble("z", wpi::hal::SimDevice::kInput, 0.0);

2
wpilibc/src/main/native/cpp/hardware/accelerometer/AnalogAccelerometer.cpp
View File

@@ -55,5 +55,5 @@ void AnalogAccelerometer::InitAccelerometer() {
HAL_ReportUsage("IO", m_analogInput->GetChannel(), "Accelerometer");
wpi::util::SendableRegistry::Add(this, "Accelerometer",
m_analogInput->GetChannel());
m_analogInput->GetChannel());
}

2
wpilibc/src/main/native/cpp/hardware/bus/CAN.cpp
View File

@@ -23,7 +23,7 @@ CAN::CAN(int busId, int deviceId, int deviceManufacturer, int deviceType) {
busId, static_cast<HAL_CANManufacturer>(deviceManufacturer), deviceId,
static_cast<HAL_CANDeviceType>(deviceType), &status);
WPILIB_CheckErrorStatus(status, "device id {} mfg {} type {}", deviceId,
deviceManufacturer, deviceType);
deviceManufacturer, deviceType);
HAL_ReportUsage(
fmt::format("CAN[{}][{}][{}]", deviceType, deviceManufacturer, deviceId),

15
wpilibc/src/main/native/cpp/hardware/bus/SerialPort.cpp
View File

@@ -25,10 +25,11 @@ SerialPort::SerialPort(int baudRate, Port port, int dataBits,
HAL_SetSerialDataBits(m_portHandle, dataBits, &status);
WPILIB_CheckErrorStatus(status, "SetSerialDataBits {}", dataBits);
HAL_SetSerialParity(m_portHandle, parity, &status);
WPILIB_CheckErrorStatus(status, "SetSerialParity {}", static_cast<int>(parity));
WPILIB_CheckErrorStatus(status, "SetSerialParity {}",
static_cast<int>(parity));
HAL_SetSerialStopBits(m_portHandle, stopBits, &status);
WPILIB_CheckErrorStatus(status, "SetSerialStopBits {}",
static_cast<int>(stopBits));
static_cast<int>(stopBits));
// Set the default timeout to 5 seconds.
SetTimeout(5_s);
@@ -55,10 +56,11 @@ SerialPort::SerialPort(int baudRate, std::string_view portName, Port port,
HAL_SetSerialDataBits(m_portHandle, dataBits, &status);
WPILIB_CheckErrorStatus(status, "SetSerialDataBits {}", dataBits);
HAL_SetSerialParity(m_portHandle, parity, &status);
WPILIB_CheckErrorStatus(status, "SetSerialParity {}", static_cast<int>(parity));
WPILIB_CheckErrorStatus(status, "SetSerialParity {}",
static_cast<int>(parity));
HAL_SetSerialStopBits(m_portHandle, stopBits, &status);
WPILIB_CheckErrorStatus(status, "SetSerialStopBits {}",
static_cast<int>(stopBits));
static_cast<int>(stopBits));
// Set the default timeout to 5 seconds.
SetTimeout(5_s);
@@ -75,7 +77,7 @@ void SerialPort::SetFlowControl(SerialPort::FlowControl flowControl) {
int32_t status = 0;
HAL_SetSerialFlowControl(m_portHandle, flowControl, &status);
WPILIB_CheckErrorStatus(status, "SetFlowControl {}",
static_cast<int>(flowControl));
static_cast<int>(flowControl));
}
void SerialPort::EnableTermination(char terminator) {
@@ -137,7 +139,8 @@ void SerialPort::SetWriteBufferSize(int size) {
void SerialPort::SetWriteBufferMode(SerialPort::WriteBufferMode mode) {
int32_t status = 0;
HAL_SetSerialWriteMode(m_portHandle, mode, &status);
WPILIB_CheckErrorStatus(status, "SetWriteBufferMode {}", static_cast<int>(mode));
WPILIB_CheckErrorStatus(status, "SetWriteBufferMode {}",
static_cast<int>(mode));
}
void SerialPort::Flush() {

6
wpilibc/src/main/native/cpp/hardware/discrete/PWM.cpp
View File

@@ -82,7 +82,7 @@ void PWM::SetOutputPeriod(OutputPeriod mult) {
break;
default:
throw WPILIB_MakeError(err::InvalidParameter, "OutputPeriod value {}",
static_cast<int>(mult));
static_cast<int>(mult));
}
WPILIB_CheckErrorStatus(status, "Channel {}", m_channel);
@@ -101,5 +101,7 @@ void PWM::InitSendable(wpi::util::SendableBuilder& builder) {
builder.SetActuator(true);
builder.AddDoubleProperty(
"Value", [=, this] { return GetPulseTime().value(); },
[=, this](double value) { SetPulseTime(wpi::units::millisecond_t{value}); });
[=, this](double value) {
SetPulseTime(wpi::units::millisecond_t{value});
});
}

9
wpilibc/src/main/native/cpp/hardware/led/LEDPattern.cpp
View File

@@ -55,7 +55,7 @@ LEDPattern LEDPattern::Reversed() {
LEDPattern LEDPattern::OffsetBy(int offset) {
return MapIndex([offset](size_t bufLen, size_t i) {
return wpi::math::FloorMod(static_cast<int>(i) + offset,
static_cast<int>(bufLen));
static_cast<int>(bufLen));
});
}
@@ -74,7 +74,7 @@ LEDPattern LEDPattern::ScrollAtRelativeSpeed(wpi::units::hertz_t velocity) {
int offset = static_cast<int>(std::floor(t * bufLen));
return wpi::math::FloorMod(static_cast<int>(i) + offset,
static_cast<int>(bufLen));
static_cast<int>(bufLen));
});
}
@@ -95,11 +95,12 @@ LEDPattern LEDPattern::ScrollAtAbsoluteSpeed(
auto offset = static_cast<int64_t>(now) / microsPerLed;
return wpi::math::FloorMod(static_cast<int>(i) + offset,
static_cast<int>(bufLen));
static_cast<int>(bufLen));
});
}
LEDPattern LEDPattern::Blink(wpi::units::second_t onTime, wpi::units::second_t offTime) {
LEDPattern LEDPattern::Blink(wpi::units::second_t onTime,
wpi::units::second_t offTime) {
auto totalMicros = wpi::units::microsecond_t{onTime + offTime}.to<uint64_t>();
auto onMicros = wpi::units::microsecond_t{onTime}.to<uint64_t>();

14
wpilibc/src/main/native/cpp/hardware/motor/MotorSafety.cpp
View File

@@ -158,18 +158,20 @@ void MotorSafety::Check() {
}
if (stopTime < Timer::GetFPGATimestamp()) {
WPILIB_ReportError(err::Timeout,
"{}... Output not updated often enough. See "
"https://docs.wpilib.org/motorsafety for more information.",
GetDescription());
WPILIB_ReportError(
err::Timeout,
"{}... Output not updated often enough. See "
"https://docs.wpilib.org/motorsafety for more information.",
GetDescription());
try {
StopMotor();
} catch (wpi::RuntimeError& e) {
e.Report();
} catch (std::exception& e) {
WPILIB_ReportError(err::Error, "{} StopMotor threw unexpected exception: {}",
GetDescription(), e.what());
WPILIB_ReportError(err::Error,
"{} StopMotor threw unexpected exception: {}",
GetDescription(), e.what());
}
}
}

10
wpilibc/src/main/native/cpp/hardware/pneumatic/Compressor.cpp
View File

@@ -63,13 +63,15 @@ void Compressor::EnableDigital() {
m_module->EnableCompressorDigital();
}
void Compressor::EnableAnalog(wpi::units::pounds_per_square_inch_t minPressure,
wpi::units::pounds_per_square_inch_t maxPressure) {
void Compressor::EnableAnalog(
wpi::units::pounds_per_square_inch_t minPressure,
wpi::units::pounds_per_square_inch_t maxPressure) {
m_module->EnableCompressorAnalog(minPressure, maxPressure);
}
void Compressor::EnableHybrid(wpi::units::pounds_per_square_inch_t minPressure,
wpi::units::pounds_per_square_inch_t maxPressure) {
void Compressor::EnableHybrid(
wpi::units::pounds_per_square_inch_t minPressure,
wpi::units::pounds_per_square_inch_t maxPressure) {
m_module->EnableCompressorHybrid(minPressure, maxPressure);
}

17
wpilibc/src/main/native/cpp/hardware/pneumatic/DoubleSolenoid.cpp
View File

@@ -23,11 +23,11 @@ DoubleSolenoid::DoubleSolenoid(int busId, int module,
m_reverseChannel{reverseChannel} {
if (!m_module->CheckSolenoidChannel(m_forwardChannel)) {
throw WPILIB_MakeError(err::ChannelIndexOutOfRange, "Channel {}",
m_forwardChannel);
m_forwardChannel);
}
if (!m_module->CheckSolenoidChannel(m_reverseChannel)) {
throw WPILIB_MakeError(err::ChannelIndexOutOfRange, "Channel {}",
m_reverseChannel);
m_reverseChannel);
}
m_forwardMask = 1 << forwardChannel;
@@ -37,14 +37,15 @@ DoubleSolenoid::DoubleSolenoid(int busId, int module,
int allocMask = m_module->CheckAndReserveSolenoids(m_mask);
if (allocMask != 0) {
if (allocMask == m_mask) {
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channels {} and {}",
m_forwardChannel, m_reverseChannel);
throw WPILIB_MakeError(err::ResourceAlreadyAllocated,
"Channels {} and {}", m_forwardChannel,
m_reverseChannel);
} else if (allocMask == m_forwardMask) {
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channel {}",
m_forwardChannel);
m_forwardChannel);
} else {
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channel {}",
m_reverseChannel);
m_reverseChannel);
}
}
@@ -52,8 +53,8 @@ DoubleSolenoid::DoubleSolenoid(int busId, int module,
fmt::format("Solenoid[{},{}]", m_forwardChannel, m_reverseChannel),
"DoubleSolenoid");
wpi::util::SendableRegistry::Add(this, "DoubleSolenoid",
m_module->GetModuleNumber(), m_forwardChannel);
wpi::util::SendableRegistry::Add(
this, "DoubleSolenoid", m_module->GetModuleNumber(), m_forwardChannel);
}
DoubleSolenoid::DoubleSolenoid(int busId, PneumaticsModuleType moduleType,

47
wpilibc/src/main/native/cpp/hardware/pneumatic/PneumaticHub.cpp
View File

@@ -26,21 +26,22 @@
using namespace wpi;
/** Converts volts to PSI per the REV Analog Pressure Sensor datasheet. */
wpi::units::pounds_per_square_inch_t VoltsToPSI(wpi::units::volt_t sensorVoltage,
wpi::units::volt_t supplyVoltage) {
wpi::units::pounds_per_square_inch_t VoltsToPSI(
wpi::units::volt_t sensorVoltage, wpi::units::volt_t supplyVoltage) {
return wpi::units::pounds_per_square_inch_t{
250 * (sensorVoltage.value() / supplyVoltage.value()) - 25};
}
/** Converts PSI to volts per the REV Analog Pressure Sensor datasheet. */
wpi::units::volt_t PSIToVolts(wpi::units::pounds_per_square_inch_t pressure,
wpi::units::volt_t supplyVoltage) {
wpi::units::volt_t supplyVoltage) {
return wpi::units::volt_t{supplyVoltage.value() *
(0.004 * pressure.value() + 0.1)};
(0.004 * pressure.value() + 0.1)};
}
wpi::util::mutex PneumaticHub::m_handleLock;
std::unique_ptr<wpi::util::DenseMap<int, std::weak_ptr<PneumaticHub::DataStore>>[]>
std::unique_ptr<
wpi::util::DenseMap<int, std::weak_ptr<PneumaticHub::DataStore>>[]>
PneumaticHub::m_handleMaps = nullptr;
// Always called under lock, so we can avoid the double lock from the magic
@@ -49,10 +50,11 @@ std::weak_ptr<PneumaticHub::DataStore>& PneumaticHub::GetDataStore(int busId,
int module) {
int32_t numBuses = HAL_GetNumCanBuses();
WPILIB_AssertMessage(busId >= 0 && busId < numBuses,
"Bus {} out of range. Must be [0-{}).", busId, numBuses);
"Bus {} out of range. Must be [0-{}).", busId, numBuses);
if (!m_handleMaps) {
m_handleMaps = std::make_unique<
wpi::util::DenseMap<int, std::weak_ptr<PneumaticHub::DataStore>>[]>(numBuses);
wpi::util::DenseMap<int, std::weak_ptr<PneumaticHub::DataStore>>[]>(
numBuses);
}
return m_handleMaps[busId][module];
}
@@ -138,17 +140,17 @@ void PneumaticHub::EnableCompressorAnalog(
wpi::units::pounds_per_square_inch_t maxPressure) {
if (minPressure >= maxPressure) {
throw WPILIB_MakeError(err::InvalidParameter,
"maxPressure must be greater than minPressure");
"maxPressure must be greater than minPressure");
}
if (minPressure < 0_psi || minPressure > 120_psi) {
throw WPILIB_MakeError(err::ParameterOutOfRange,
"minPressure must be between 0 and 120 PSI, got {}",
minPressure);
"minPressure must be between 0 and 120 PSI, got {}",
minPressure);
}
if (maxPressure < 0_psi || maxPressure > 120_psi) {
throw WPILIB_MakeError(err::ParameterOutOfRange,
"maxPressure must be between 0 and 120 PSI, got {}",
maxPressure);
"maxPressure must be between 0 and 120 PSI, got {}",
maxPressure);
}
// Send the voltage as it would be if the 5V rail was at exactly 5V.
@@ -168,17 +170,17 @@ void PneumaticHub::EnableCompressorHybrid(
wpi::units::pounds_per_square_inch_t maxPressure) {
if (minPressure >= maxPressure) {
throw WPILIB_MakeError(err::InvalidParameter,
"maxPressure must be greater than minPressure");
"maxPressure must be greater than minPressure");
}
if (minPressure < 0_psi || minPressure > 120_psi) {
throw WPILIB_MakeError(err::ParameterOutOfRange,
"minPressure must be between 0 and 120 PSI, got {}",
minPressure);
"minPressure must be between 0 and 120 PSI, got {}",
minPressure);
}
if (maxPressure < 0_psi || maxPressure > 120_psi) {
throw WPILIB_MakeError(err::ParameterOutOfRange,
"maxPressure must be between 0 and 120 PSI, got {}",
maxPressure);
"maxPressure must be between 0 and 120 PSI, got {}",
maxPressure);
}
// Send the voltage as it would be if the 5V rail was at exactly 5V.
@@ -245,7 +247,8 @@ void PneumaticHub::FireOneShot(int index) {
WPILIB_ReportError(status, "Module {}", m_module);
}
void PneumaticHub::SetOneShotDuration(int index, wpi::units::second_t duration) {
void PneumaticHub::SetOneShotDuration(int index,
wpi::units::second_t duration) {
m_dataStore->m_oneShotDurMs[index] = duration;
}
@@ -360,7 +363,7 @@ bool PneumaticHub::Faults::GetChannelFault(int channel) const {
return Channel15Fault != 0;
default:
throw WPILIB_MakeError(err::ChannelIndexOutOfRange,
"Pneumatics fault channel out of bounds!");
"Pneumatics fault channel out of bounds!");
}
}
@@ -405,13 +408,15 @@ wpi::units::volt_t PneumaticHub::GetAnalogVoltage(int channel) const {
return wpi::units::volt_t{voltage};
}
wpi::units::pounds_per_square_inch_t PneumaticHub::GetPressure(int channel) const {
wpi::units::pounds_per_square_inch_t PneumaticHub::GetPressure(
int channel) const {
int32_t status = 0;
auto sensorVoltage = HAL_GetREVPHAnalogVoltage(m_handle, channel, &status);
WPILIB_ReportError(status, "Module {}", m_module);
auto supplyVoltage = HAL_GetREVPH5VVoltage(m_handle, &status);
WPILIB_ReportError(status, "Module {}", m_module);
return VoltsToPSI(wpi::units::volt_t{sensorVoltage}, wpi::units::volt_t{supplyVoltage});
return VoltsToPSI(wpi::units::volt_t{sensorVoltage},
wpi::units::volt_t{supplyVoltage});
}
Solenoid PneumaticHub::MakeSolenoid(int channel) {

4
wpilibc/src/main/native/cpp/hardware/pneumatic/PneumaticsBase.cpp
View File

@@ -35,7 +35,7 @@ std::shared_ptr<PneumaticsBase> PneumaticsBase::GetForType(
return PneumaticHub::GetForModule(busId, module);
}
throw WPILIB_MakeError(err::InvalidParameter, "{}",
static_cast<int>(moduleType));
static_cast<int>(moduleType));
}
int PneumaticsBase::GetDefaultForType(PneumaticsModuleType moduleType) {
@@ -45,5 +45,5 @@ int PneumaticsBase::GetDefaultForType(PneumaticsModuleType moduleType) {
return SensorUtil::GetDefaultREVPHModule();
}
throw WPILIB_MakeError(err::InvalidParameter, "{}",
static_cast<int>(moduleType));
static_cast<int>(moduleType));
}

13
wpilibc/src/main/native/cpp/hardware/pneumatic/PneumaticsControlModule.cpp
View File

@@ -23,8 +23,8 @@
using namespace wpi;
wpi::util::mutex PneumaticsControlModule::m_handleLock;
std::unique_ptr<
wpi::util::DenseMap<int, std::weak_ptr<PneumaticsControlModule::DataStore>>[]>
std::unique_ptr<wpi::util::DenseMap<
int, std::weak_ptr<PneumaticsControlModule::DataStore>>[]>
PneumaticsControlModule::m_handleMaps = nullptr;
// Always called under lock, so we can avoid the double lock from the magic
@@ -33,7 +33,7 @@ std::weak_ptr<PneumaticsControlModule::DataStore>&
PneumaticsControlModule::GetDataStore(int busId, int module) {
int32_t numBuses = HAL_GetNumCanBuses();
WPILIB_AssertMessage(busId >= 0 && busId < numBuses,
"Bus {} out of range. Must be [0-{}).", busId, numBuses);
"Bus {} out of range. Must be [0-{}).", busId, numBuses);
if (!m_handleMaps) {
m_handleMaps = std::make_unique<wpi::util::DenseMap<
int, std::weak_ptr<PneumaticsControlModule::DataStore>>[]>(numBuses);
@@ -234,8 +234,8 @@ void PneumaticsControlModule::FireOneShot(int index) {
WPILIB_ReportError(status, "Module {}", m_module);
}
void PneumaticsControlModule::SetOneShotDuration(int index,
wpi::units::second_t duration) {
void PneumaticsControlModule::SetOneShotDuration(
int index, wpi::units::second_t duration) {
int32_t status = 0;
wpi::units::millisecond_t millis = duration;
HAL_SetCTREPCMOneShotDuration(m_handle, index, millis.to<int32_t>(), &status);
@@ -275,7 +275,8 @@ void PneumaticsControlModule::UnreserveCompressor() {
m_dataStore->m_compressorReserved = false;
}
wpi::units::volt_t PneumaticsControlModule::GetAnalogVoltage(int channel) const {
wpi::units::volt_t PneumaticsControlModule::GetAnalogVoltage(
int channel) const {
return 0_V;
}

10
wpilibc/src/main/native/cpp/hardware/pneumatic/Solenoid.cpp
View File

@@ -19,17 +19,19 @@ Solenoid::Solenoid(int busId, int module, PneumaticsModuleType moduleType,
: m_module{PneumaticsBase::GetForType(busId, module, moduleType)},
m_channel{channel} {
if (!m_module->CheckSolenoidChannel(m_channel)) {
throw WPILIB_MakeError(err::ChannelIndexOutOfRange, "Channel {}", m_channel);
throw WPILIB_MakeError(err::ChannelIndexOutOfRange, "Channel {}",
m_channel);
}
m_mask = 1 << channel;
if (m_module->CheckAndReserveSolenoids(m_mask) != 0) {
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channel {}", m_channel);
throw WPILIB_MakeError(err::ResourceAlreadyAllocated, "Channel {}",
m_channel);
}
m_module->ReportUsage(fmt::format("Solenoid[{}]", m_channel), "Solenoid");
wpi::util::SendableRegistry::Add(this, "Solenoid", m_module->GetModuleNumber(),
m_channel);
wpi::util::SendableRegistry::Add(this, "Solenoid",
m_module->GetModuleNumber(), m_channel);
}
Solenoid::Solenoid(int busId, PneumaticsModuleType moduleType, int channel)

4
wpilibc/src/main/native/cpp/hardware/power/PowerDistribution.cpp
View File

@@ -246,7 +246,7 @@ bool PowerDistribution::Faults::GetBreakerFault(int channel) const {
return Channel23BreakerFault != 0;
default:
throw WPILIB_MakeError(err::ChannelIndexOutOfRange,
"Power distribution fault channel out of bounds!");
"Power distribution fault channel out of bounds!");
}
}
@@ -302,7 +302,7 @@ bool PowerDistribution::StickyFaults::GetBreakerFault(int channel) const {
return Channel23BreakerFault != 0;
default:
throw WPILIB_MakeError(err::ChannelIndexOutOfRange,
"Power distribution fault channel out of bounds!");
"Power distribution fault channel out of bounds!");
}
}

5
wpilibc/src/main/native/cpp/hardware/rotation/AnalogEncoder.cpp
View File

@@ -58,7 +58,8 @@ AnalogEncoder::AnalogEncoder(std::shared_ptr<AnalogInput> analogInput,
}
void AnalogEncoder::Init(double fullRange, double expectedZero) {
m_simDevice = wpi::hal::SimDevice{"AnalogEncoder", m_analogInput->GetChannel()};
m_simDevice =
wpi::hal::SimDevice{"AnalogEncoder", m_analogInput->GetChannel()};
if (m_simDevice) {
m_simPosition = m_simDevice.CreateDouble("Position", false, 0.0);
@@ -70,7 +71,7 @@ void AnalogEncoder::Init(double fullRange, double expectedZero) {
HAL_ReportUsage("IO", m_analogInput->GetChannel(), "AnalogEncoder");
wpi::util::SendableRegistry::Add(this, "Analog Encoder",
m_analogInput->GetChannel());
m_analogInput->GetChannel());
}
double AnalogEncoder::Get() const {

8
wpilibc/src/main/native/cpp/hardware/rotation/AnalogPotentiometer.cpp
View File

@@ -23,9 +23,9 @@ AnalogPotentiometer::AnalogPotentiometer(int channel, double fullRange,
AnalogPotentiometer::AnalogPotentiometer(AnalogInput* input, double fullRange,
double offset)
: AnalogPotentiometer(
std::shared_ptr<AnalogInput>(input, wpi::util::NullDeleter<AnalogInput>()),
fullRange, offset) {}
: AnalogPotentiometer(std::shared_ptr<AnalogInput>(
input, wpi::util::NullDeleter<AnalogInput>()),
fullRange, offset) {}
AnalogPotentiometer::AnalogPotentiometer(std::shared_ptr<AnalogInput> input,
double fullRange, double offset)
@@ -33,7 +33,7 @@ AnalogPotentiometer::AnalogPotentiometer(std::shared_ptr<AnalogInput> input,
m_fullRange(fullRange),
m_offset(offset) {
wpi::util::SendableRegistry::Add(this, "AnalogPotentiometer",
m_analog_input->GetChannel());
m_analog_input->GetChannel());
}
double AnalogPotentiometer::Get() const {

8
wpilibc/src/main/native/cpp/hardware/rotation/DutyCycleEncoder.cpp
View File

@@ -61,19 +61,19 @@ DutyCycleEncoder::DutyCycleEncoder(std::shared_ptr<DutyCycle> dutyCycle,
void DutyCycleEncoder::Init(double fullRange, double expectedZero) {
m_simDevice = wpi::hal::SimDevice{"DutyCycle:DutyCycleEncoder",
m_dutyCycle->GetSourceChannel()};
m_dutyCycle->GetSourceChannel()};
if (m_simDevice) {
m_simPosition = m_simDevice.CreateDouble("Position", false, 0.0);
m_simIsConnected =
m_simDevice.CreateBoolean("Connected", wpi::hal::SimDevice::kInput, true);
m_simIsConnected = m_simDevice.CreateBoolean(
"Connected", wpi::hal::SimDevice::kInput, true);
}
m_fullRange = fullRange;
m_expectedZero = expectedZero;
wpi::util::SendableRegistry::Add(this, "DutyCycle Encoder",
m_dutyCycle->GetSourceChannel());
m_dutyCycle->GetSourceChannel());
}
double DutyCycleEncoder::Get() const {

3
wpilibc/src/main/native/cpp/opmode/IterativeRobotBase.cpp
View File

@@ -193,7 +193,8 @@ void IterativeRobotBase::LoopFunc() {
}
void IterativeRobotBase::PrintLoopOverrunMessage() {
WPILIB_ReportError(err::Error, "Loop time of {:.6f}s overrun", m_period.value());
WPILIB_ReportError(err::Error, "Loop time of {:.6f}s overrun",
m_period.value());
}
void IterativeRobotBase::PrintWatchdogEpochs() {

9
wpilibc/src/main/native/cpp/opmode/TimedRobot.cpp
View File

@@ -75,7 +75,8 @@ void TimedRobot::EndCompetition() {
HAL_StopNotifier(m_notifier, &status);
}
TimedRobot::TimedRobot(wpi::units::second_t period) : IterativeRobotBase(period) {
TimedRobot::TimedRobot(wpi::units::second_t period)
: IterativeRobotBase(period) {
m_startTime = std::chrono::microseconds{RobotController::GetFPGATime()};
AddPeriodic([=, this] { LoopFunc(); }, period);
@@ -87,7 +88,8 @@ TimedRobot::TimedRobot(wpi::units::second_t period) : IterativeRobotBase(period)
HAL_ReportUsage("Framework", "TimedRobot");
}
TimedRobot::TimedRobot(wpi::units::hertz_t frequency) : TimedRobot{1 / frequency} {}
TimedRobot::TimedRobot(wpi::units::hertz_t frequency)
: TimedRobot{1 / frequency} {}
TimedRobot::~TimedRobot() {
if (m_notifier != HAL_kInvalidHandle) {
@@ -102,7 +104,8 @@ uint64_t TimedRobot::GetLoopStartTime() {
}
void TimedRobot::AddPeriodic(std::function<void()> callback,
wpi::units::second_t period, wpi::units::second_t offset) {
wpi::units::second_t period,
wpi::units::second_t offset) {
m_callbacks.emplace(
callback, m_startTime,
std::chrono::microseconds{static_cast<int64_t>(period.value() * 1e6)},

6
wpilibc/src/main/native/cpp/opmode/TimesliceRobot.cpp
View File

@@ -17,9 +17,9 @@ void TimesliceRobot::Schedule(std::function<void()> func,
wpi::units::second_t allocation) {
if (m_nextOffset + allocation > m_controllerPeriod) {
throw WPILIB_MakeError(err::Error,
"Function scheduled at offset {} with allocation {} "
"exceeded controller period of {}\n",
m_nextOffset, allocation, m_controllerPeriod);
"Function scheduled at offset {} with allocation {} "
"exceeded controller period of {}\n",
m_nextOffset, allocation, m_controllerPeriod);
}
AddPeriodic(func, m_controllerPeriod, m_nextOffset);

6
wpilibc/src/main/native/cpp/simulation/DCMotorSim.cpp
View File

@@ -58,13 +58,15 @@ wpi::units::radians_per_second_t DCMotorSim::GetAngularVelocity() const {
return wpi::units::radians_per_second_t{GetOutput(1)};
}
wpi::units::radians_per_second_squared_t DCMotorSim::GetAngularAcceleration() const {
wpi::units::radians_per_second_squared_t DCMotorSim::GetAngularAcceleration()
const {
return wpi::units::radians_per_second_squared_t{
(m_plant.A() * m_x + m_plant.B() * m_u)(1, 0)};
}
wpi::units::newton_meter_t DCMotorSim::GetTorque() const {
return wpi::units::newton_meter_t{GetAngularAcceleration().value() * m_j.value()};
return wpi::units::newton_meter_t{GetAngularAcceleration().value() *
m_j.value()};
}
wpi::units::ampere_t DCMotorSim::GetCurrentDraw() const {

39
wpilibc/src/main/native/cpp/simulation/DifferentialDrivetrainSim.cpp
View File

@@ -16,8 +16,9 @@ using namespace wpi;
using namespace wpi::sim;
DifferentialDrivetrainSim::DifferentialDrivetrainSim(
wpi::math::LinearSystem<2, 2, 2> plant, wpi::units::meter_t trackwidth, wpi::math::DCMotor driveMotor,
double gearRatio, wpi::units::meter_t wheelRadius,
wpi::math::LinearSystem<2, 2, 2> plant, wpi::units::meter_t trackwidth,
wpi::math::DCMotor driveMotor, double gearRatio,
wpi::units::meter_t wheelRadius,
const std::array<double, 7>& measurementStdDevs)
: m_plant(std::move(plant)),
m_rb(trackwidth / 2.0),
@@ -32,9 +33,10 @@ DifferentialDrivetrainSim::DifferentialDrivetrainSim(
}
DifferentialDrivetrainSim::DifferentialDrivetrainSim(
wpi::math::DCMotor driveMotor, double gearing, wpi::units::kilogram_square_meter_t J,
wpi::units::kilogram_t mass, wpi::units::meter_t wheelRadius,
wpi::units::meter_t trackwidth, const std::array<double, 7>& measurementStdDevs)
wpi::math::DCMotor driveMotor, double gearing,
wpi::units::kilogram_square_meter_t J, wpi::units::kilogram_t mass,
wpi::units::meter_t wheelRadius, wpi::units::meter_t trackwidth,
const std::array<double, 7>& measurementStdDevs)
: DifferentialDrivetrainSim(
wpi::math::LinearSystemId::DrivetrainVelocitySystem(
driveMotor, mass, wheelRadius, trackwidth / 2.0, J, gearing),
@@ -42,8 +44,8 @@ DifferentialDrivetrainSim::DifferentialDrivetrainSim(
Eigen::Vector2d DifferentialDrivetrainSim::ClampInput(
const Eigen::Vector2d& u) {
return wpi::math::DesaturateInputVector<2>(u,
wpi::RobotController::GetInputVoltage());
return wpi::math::DesaturateInputVector<2>(
u, wpi::RobotController::GetInputVoltage());
}
void DifferentialDrivetrainSim::SetInputs(wpi::units::volt_t leftVoltage,
@@ -57,7 +59,8 @@ void DifferentialDrivetrainSim::SetGearing(double newGearing) {
}
void DifferentialDrivetrainSim::Update(wpi::units::second_t dt) {
m_x = wpi::math::RKDP([this](auto& x, auto& u) { return Dynamics(x, u); }, m_x, m_u, dt);
m_x = wpi::math::RKDP([this](auto& x, auto& u) { return Dynamics(x, u); },
m_x, m_u, dt);
m_y = m_x + wpi::math::MakeWhiteNoiseVector<7>(m_measurementStdDevs);
}
@@ -87,22 +90,24 @@ wpi::math::Rotation2d DifferentialDrivetrainSim::GetHeading() const {
wpi::math::Pose2d DifferentialDrivetrainSim::GetPose() const {
return wpi::math::Pose2d{wpi::units::meter_t{GetOutput(State::kX)},
wpi::units::meter_t{GetOutput(State::kY)}, GetHeading()};
wpi::units::meter_t{GetOutput(State::kY)},
GetHeading()};
}
wpi::units::ampere_t DifferentialDrivetrainSim::GetLeftCurrentDraw() const {
return m_motor.Current(wpi::units::radians_per_second_t{m_x(State::kLeftVelocity) *
m_currentGearing /
m_wheelRadius.value()},
wpi::units::volt_t{m_u(0)}) *
return m_motor.Current(
wpi::units::radians_per_second_t{m_x(State::kLeftVelocity) *
m_currentGearing /
m_wheelRadius.value()},
wpi::units::volt_t{m_u(0)}) *
wpi::util::sgn(m_u(0));
}
wpi::units::ampere_t DifferentialDrivetrainSim::GetRightCurrentDraw() const {
return m_motor.Current(
wpi::units::radians_per_second_t{m_x(State::kRightVelocity) *
m_currentGearing /
m_wheelRadius.value()},
m_currentGearing /
m_wheelRadius.value()},
wpi::units::volt_t{m_u(1)}) *
wpi::util::sgn(m_u(1));
}
@@ -123,8 +128,8 @@ void DifferentialDrivetrainSim::SetPose(const wpi::math::Pose2d& pose) {
m_x(State::kRightPosition) = 0;
}
wpi::math::Vectord<7> DifferentialDrivetrainSim::Dynamics(const wpi::math::Vectord<7>& x,
const Eigen::Vector2d& u) {
wpi::math::Vectord<7> DifferentialDrivetrainSim::Dynamics(
const wpi::math::Vectord<7>& x, const Eigen::Vector2d& u) {
// Because G² can be factored out of A, we can divide by the old ratio
// squared and multiply by the new ratio squared to get a new drivetrain
// model.

31
wpilibc/src/main/native/cpp/simulation/ElevatorSim.cpp
View File

@@ -13,7 +13,8 @@ using namespace wpi;
using namespace wpi::sim;
ElevatorSim::ElevatorSim(const wpi::math::LinearSystem<2, 1, 2>& plant,
const wpi::math::DCMotor& gearbox, wpi::units::meter_t minHeight,
const wpi::math::DCMotor& gearbox,
wpi::units::meter_t minHeight,
wpi::units::meter_t maxHeight, bool simulateGravity,
wpi::units::meter_t startingHeight,
const std::array<double, 2>& measurementStdDevs)
@@ -27,12 +28,13 @@ ElevatorSim::ElevatorSim(const wpi::math::LinearSystem<2, 1, 2>& plant,
ElevatorSim::ElevatorSim(const wpi::math::DCMotor& gearbox, double gearing,
wpi::units::kilogram_t carriageMass,
wpi::units::meter_t drumRadius, wpi::units::meter_t minHeight,
wpi::units::meter_t drumRadius,
wpi::units::meter_t minHeight,
wpi::units::meter_t maxHeight, bool simulateGravity,
wpi::units::meter_t startingHeight,
const std::array<double, 2>& measurementStdDevs)
: ElevatorSim(wpi::math::LinearSystemId::ElevatorSystem(gearbox, carriageMass,
drumRadius, gearing),
: ElevatorSim(wpi::math::LinearSystemId::ElevatorSystem(
gearbox, carriageMass, drumRadius, gearing),
gearbox, minHeight, maxHeight, simulateGravity,
startingHeight, measurementStdDevs) {}
@@ -41,18 +43,19 @@ template <typename Distance>
std::same_as<wpi::units::radian, Distance>
ElevatorSim::ElevatorSim(decltype(1_V / Velocity_t<Distance>(1)) kV,
decltype(1_V / Acceleration_t<Distance>(1)) kA,
const wpi::math::DCMotor& gearbox, wpi::units::meter_t minHeight,
const wpi::math::DCMotor& gearbox,
wpi::units::meter_t minHeight,
wpi::units::meter_t maxHeight, bool simulateGravity,
wpi::units::meter_t startingHeight,
const std::array<double, 2>& measurementStdDevs)
: ElevatorSim(wpi::math::LinearSystemId::IdentifyPositionSystem(kV, kA), gearbox,
minHeight, maxHeight, simulateGravity, startingHeight,
measurementStdDevs) {}
: ElevatorSim(wpi::math::LinearSystemId::IdentifyPositionSystem(kV, kA),
gearbox, minHeight, maxHeight, simulateGravity,
startingHeight, measurementStdDevs) {}
void ElevatorSim::SetState(wpi::units::meter_t position,
wpi::units::meters_per_second_t velocity) {
SetState(
wpi::math::Vectord<2>{std::clamp(position, m_minHeight, m_maxHeight), velocity});
SetState(wpi::math::Vectord<2>{std::clamp(position, m_minHeight, m_maxHeight),
velocity});
}
bool ElevatorSim::WouldHitLowerLimit(wpi::units::meter_t elevatorHeight) const {
@@ -101,10 +104,12 @@ void ElevatorSim::SetInputVoltage(wpi::units::volt_t voltage) {
ClampInput(wpi::RobotController::GetBatteryVoltage().value());
}
wpi::math::Vectord<2> ElevatorSim::UpdateX(const wpi::math::Vectord<2>& currentXhat,
const wpi::math::Vectord<1>& u, wpi::units::second_t dt) {
wpi::math::Vectord<2> ElevatorSim::UpdateX(
const wpi::math::Vectord<2>& currentXhat, const wpi::math::Vectord<1>& u,
wpi::units::second_t dt) {
auto updatedXhat = wpi::math::RKDP(
[&](const wpi::math::Vectord<2>& x, const wpi::math::Vectord<1>& u_) -> wpi::math::Vectord<2> {
[&](const wpi::math::Vectord<2>& x,
const wpi::math::Vectord<1>& u_) -> wpi::math::Vectord<2> {
wpi::math::Vectord<2> xdot = m_plant.A() * x + m_plant.B() * u;
if (m_simulateGravity) {

3
wpilibc/src/main/native/cpp/simulation/FlywheelSim.cpp
View File

@@ -51,7 +51,8 @@ wpi::units::radians_per_second_squared_t FlywheelSim::GetAngularAcceleration()
}
wpi::units::newton_meter_t FlywheelSim::GetTorque() const {
return wpi::units::newton_meter_t{GetAngularAcceleration().value() * m_j.value()};
return wpi::units::newton_meter_t{GetAngularAcceleration().value() *
m_j.value()};
}
wpi::units::ampere_t FlywheelSim::GetCurrentDraw() const {

2
wpilibc/src/main/native/cpp/simulation/PneumaticsBaseSim.cpp
View File

@@ -25,7 +25,7 @@ std::shared_ptr<PneumaticsBaseSim> PneumaticsBaseSim::GetForType(
default:
throw WPILIB_MakeError(err::InvalidParameter, "{}",
static_cast<int>(module));
static_cast<int>(module));
}
}

34
wpilibc/src/main/native/cpp/simulation/SingleJointedArmSim.cpp
View File

@@ -16,7 +16,8 @@ using namespace wpi;
using namespace wpi::sim;
SingleJointedArmSim::SingleJointedArmSim(
const wpi::math::LinearSystem<2, 1, 2>& system, const wpi::math::DCMotor& gearbox, double gearing,
const wpi::math::LinearSystem<2, 1, 2>& system,
const wpi::math::DCMotor& gearbox, double gearing,
wpi::units::meter_t armLength, wpi::units::radian_t minAngle,
wpi::units::radian_t maxAngle, bool simulateGravity,
wpi::units::radian_t startingAngle,
@@ -32,26 +33,29 @@ SingleJointedArmSim::SingleJointedArmSim(
}
SingleJointedArmSim::SingleJointedArmSim(
const wpi::math::DCMotor& gearbox, double gearing, wpi::units::kilogram_square_meter_t moi,
wpi::units::meter_t armLength, wpi::units::radian_t minAngle,
wpi::units::radian_t maxAngle, bool simulateGravity,
wpi::units::radian_t startingAngle,
const wpi::math::DCMotor& gearbox, double gearing,
wpi::units::kilogram_square_meter_t moi, wpi::units::meter_t armLength,
wpi::units::radian_t minAngle, wpi::units::radian_t maxAngle,
bool simulateGravity, wpi::units::radian_t startingAngle,
const std::array<double, 2>& measurementStdDevs)
: SingleJointedArmSim(
wpi::math::LinearSystemId::SingleJointedArmSystem(gearbox, moi, gearing),
gearbox, gearing, armLength, minAngle, maxAngle, simulateGravity,
startingAngle, measurementStdDevs) {}
: SingleJointedArmSim(wpi::math::LinearSystemId::SingleJointedArmSystem(
gearbox, moi, gearing),
gearbox, gearing, armLength, minAngle, maxAngle,
simulateGravity, startingAngle, measurementStdDevs) {}
void SingleJointedArmSim::SetState(wpi::units::radian_t angle,
wpi::units::radians_per_second_t velocity) {
SetState(wpi::math::Vectord<2>{std::clamp(angle, m_minAngle, m_maxAngle), velocity});
SetState(wpi::math::Vectord<2>{std::clamp(angle, m_minAngle, m_maxAngle),
velocity});
}
bool SingleJointedArmSim::WouldHitLowerLimit(wpi::units::radian_t armAngle) const {
bool SingleJointedArmSim::WouldHitLowerLimit(
wpi::units::radian_t armAngle) const {
return armAngle <= m_minAngle;
}
bool SingleJointedArmSim::WouldHitUpperLimit(wpi::units::radian_t armAngle) const {
bool SingleJointedArmSim::WouldHitUpperLimit(
wpi::units::radian_t armAngle) const {
return armAngle >= m_maxAngle;
}
@@ -84,9 +88,9 @@ void SingleJointedArmSim::SetInputVoltage(wpi::units::volt_t voltage) {
ClampInput(wpi::RobotController::GetBatteryVoltage().value());
}
wpi::math::Vectord<2> SingleJointedArmSim::UpdateX(const wpi::math::Vectord<2>& currentXhat,
const wpi::math::Vectord<1>& u,
wpi::units::second_t dt) {
wpi::math::Vectord<2> SingleJointedArmSim::UpdateX(
const wpi::math::Vectord<2>& currentXhat, const wpi::math::Vectord<1>& u,
wpi::units::second_t dt) {
// The torque on the arm is given by τ = F⋅r, where F is the force applied by
// gravity and r the distance from pivot to center of mass. Recall from
// dynamics that the sum of torques for a rigid body is τ = J⋅α, were τ is

6
wpilibc/src/main/native/cpp/smartdashboard/FieldObject2d.cpp
View File

@@ -106,8 +106,8 @@ void FieldObject2d::UpdateFromEntry() const {
}
m_poses.resize(size / 3);
for (size_t i = 0; i < size / 3; ++i) {
m_poses[i] =
wpi::math::Pose2d{wpi::units::meter_t{arr[i * 3 + 0]}, wpi::units::meter_t{arr[i * 3 + 1]},
wpi::units::degree_t{arr[i * 3 + 2]}};
m_poses[i] = wpi::math::Pose2d{wpi::units::meter_t{arr[i * 3 + 0]},
wpi::units::meter_t{arr[i * 3 + 1]},
wpi::units::degree_t{arr[i * 3 + 2]}};
}
}

5
wpilibc/src/main/native/cpp/smartdashboard/MechanismLigament2d.cpp
View File

@@ -28,7 +28,8 @@ MechanismLigament2d::MechanismLigament2d(std::string_view name, double length,
void MechanismLigament2d::UpdateEntries(
std::shared_ptr<wpi::nt::NetworkTable> table) {
m_typePub = table->GetStringTopic(".type").PublishEx(
wpi::nt::StringTopic::kTypeString, {{"SmartDashboard", kSmartDashboardType}});
wpi::nt::StringTopic::kTypeString,
{{"SmartDashboard", kSmartDashboardType}});
m_typePub.Set(kSmartDashboardType);
m_colorEntry = table->GetStringTopic("color").GetEntry("");
@@ -45,7 +46,7 @@ void MechanismLigament2d::SetColor(const Color8Bit& color) {
std::scoped_lock lock(m_mutex);
wpi::util::format_to_n_c_str(m_color, sizeof(m_color), "#{:02X}{:02X}{:02X}",
color.red, color.green, color.blue);
color.red, color.green, color.blue);
if (m_colorEntry) {
m_colorEntry.Set(m_color);

7
wpilibc/src/main/native/cpp/smartdashboard/MechanismRoot2d.cpp
View File

@@ -4,10 +4,10 @@
#include "wpi/smartdashboard/MechanismRoot2d.hpp"
#include "wpi/util/Color8Bit.hpp"
#include <memory>
#include "wpi/util/Color8Bit.hpp"
using namespace wpi;
MechanismRoot2d::MechanismRoot2d(std::string_view name, double x, double y,
@@ -21,7 +21,8 @@ void MechanismRoot2d::SetPosition(double x, double y) {
Flush();
}
void MechanismRoot2d::UpdateEntries(std::shared_ptr<wpi::nt::NetworkTable> table) {
void MechanismRoot2d::UpdateEntries(
std::shared_ptr<wpi::nt::NetworkTable> table) {
m_xPub = table->GetDoubleTopic("x").Publish();
m_yPub = table->GetDoubleTopic("y").Publish();
Flush();

25
wpilibc/src/main/native/cpp/smartdashboard/SendableBuilderImpl.cpp
View File

@@ -35,7 +35,8 @@ void SendableBuilderImpl::PropertyImpl<Topic>::Update(bool controllable,
}
}
void SendableBuilderImpl::SetTable(std::shared_ptr<wpi::nt::NetworkTable> table) {
void SendableBuilderImpl::SetTable(
std::shared_ptr<wpi::nt::NetworkTable> table) {
m_table = table;
m_controllablePublisher = table->GetBooleanTopic(".controllable").Publish();
m_controllablePublisher.SetDefault(false);
@@ -97,7 +98,8 @@ void SendableBuilderImpl::SetActuator(bool value) {
m_actuator = value;
}
void SendableBuilderImpl::SetUpdateTable(wpi::util::unique_function<void()> func) {
void SendableBuilderImpl::SetUpdateTable(
wpi::util::unique_function<void()> func) {
m_updateTables.emplace_back(std::move(func));
}
@@ -314,7 +316,8 @@ void SendableBuilderImpl::AddSmallPropertyImpl(Topic topic, Getter getter,
void SendableBuilderImpl::AddSmallStringProperty(
std::string_view key,
std::function<std::string_view(wpi::util::SmallVectorImpl<char>& buf)> getter,
std::function<std::string_view(wpi::util::SmallVectorImpl<char>& buf)>
getter,
std::function<void(std::string_view)> setter) {
AddSmallPropertyImpl<char, 128>(m_table->GetStringTopic(key),
std::move(getter), std::move(setter));
@@ -322,7 +325,8 @@ void SendableBuilderImpl::AddSmallStringProperty(
void SendableBuilderImpl::AddSmallBooleanArrayProperty(
std::string_view key,
std::function<std::span<const int>(wpi::util::SmallVectorImpl<int>& buf)> getter,
std::function<std::span<const int>(wpi::util::SmallVectorImpl<int>& buf)>
getter,
std::function<void(std::span<const int>)> setter) {
AddSmallPropertyImpl<int, 16>(m_table->GetBooleanArrayTopic(key),
std::move(getter), std::move(setter));
@@ -330,7 +334,8 @@ void SendableBuilderImpl::AddSmallBooleanArrayProperty(
void SendableBuilderImpl::AddSmallIntegerArrayProperty(
std::string_view key,
std::function<std::span<const int64_t>(wpi::util::SmallVectorImpl<int64_t>& buf)>
std::function<
std::span<const int64_t>(wpi::util::SmallVectorImpl<int64_t>& buf)>
getter,
std::function<void(std::span<const int64_t>)> setter) {
AddSmallPropertyImpl<int64_t, 16>(m_table->GetIntegerArrayTopic(key),
@@ -339,7 +344,8 @@ void SendableBuilderImpl::AddSmallIntegerArrayProperty(
void SendableBuilderImpl::AddSmallFloatArrayProperty(
std::string_view key,
std::function<std::span<const float>(wpi::util::SmallVectorImpl<float>& buf)>
std::function<
std::span<const float>(wpi::util::SmallVectorImpl<float>& buf)>
getter,
std::function<void(std::span<const float>)> setter) {
AddSmallPropertyImpl<float, 16>(m_table->GetFloatArrayTopic(key),
@@ -348,7 +354,8 @@ void SendableBuilderImpl::AddSmallFloatArrayProperty(
void SendableBuilderImpl::AddSmallDoubleArrayProperty(
std::string_view key,
std::function<std::span<const double>(wpi::util::SmallVectorImpl<double>& buf)>
std::function<
std::span<const double>(wpi::util::SmallVectorImpl<double>& buf)>
getter,
std::function<void(std::span<const double>)> setter) {
AddSmallPropertyImpl<double, 16>(m_table->GetDoubleArrayTopic(key),
@@ -357,8 +364,8 @@ void SendableBuilderImpl::AddSmallDoubleArrayProperty(
void SendableBuilderImpl::AddSmallStringArrayProperty(
std::string_view key,
std::function<
std::span<const std::string>(wpi::util::SmallVectorImpl<std::string>& buf)>
std::function<std::span<const std::string>(
wpi::util::SmallVectorImpl<std::string>& buf)>
getter,
std::function<void(std::span<const std::string>)> setter) {
AddSmallPropertyImpl<std::string, 16>(m_table->GetStringArrayTopic(key),

10
wpilibc/src/main/native/cpp/system/DataLogManager.cpp
View File

@@ -133,8 +133,8 @@ void Thread::Main() {
freeSpace = UINTMAX_MAX;
}
if (freeSpace < kFreeSpaceThreshold) {
// Delete oldest WPILIB_*.wpilog files (ignore WPILIB_TBD_*.wpilog as we just
// created one)
// Delete oldest WPILIB_*.wpilog files (ignore WPILIB_TBD_*.wpilog as we
// just created one)
std::vector<fs::directory_entry> entries;
for (auto&& entry : fs::directory_iterator{m_logDir, ec}) {
auto stem = entry.path().stem().string();
@@ -158,14 +158,14 @@ void Thread::Main() {
auto size = entry.file_size();
if (fs::remove(entry.path(), ec)) {
WPILIB_ReportWarning("DataLogManager: Deleted {}",
entry.path().string());
entry.path().string());
freeSpace += size;
if (freeSpace >= kFreeSpaceThreshold) {
break;
}
} else {
wpi::util::print(stderr, "DataLogManager: could not delete {}\n",
entry.path().string());
entry.path().string());
}
}
} else if (freeSpace < 2 * kFreeSpaceThreshold) {
@@ -330,7 +330,7 @@ Instance::Instance(std::string_view dir, std::string_view filename,
entry.path().extension() == ".wpilog") {
if (!fs::remove(entry, ec)) {
wpi::util::print(stderr, "DataLogManager: could not delete {}\n",
entry.path().string());
entry.path().string());
}
}
}

4
wpilibc/src/main/native/cpp/system/Watchdog.cpp
View File

@@ -34,7 +34,7 @@ class Watchdog::Impl {
wpi::util::mutex m_mutex;
std::atomic<HAL_NotifierHandle> m_notifier;
wpi::util::priority_queue<Watchdog*, std::vector<Watchdog*>,
DerefGreater<Watchdog*>>
DerefGreater<Watchdog*>>
m_watchdogs;
void UpdateAlarm();
@@ -115,7 +115,7 @@ void Watchdog::Impl::Main() {
watchdog->m_lastTimeoutPrintTime = now;
if (!watchdog->m_suppressTimeoutMessage) {
WPILIB_ReportWarning("Watchdog not fed within {:.6f}s",
watchdog->m_timeout.value());
watchdog->m_timeout.value());
}
}

2
wpilibc/src/main/native/cpp/util/Alert.cpp
View File

@@ -71,7 +71,7 @@ class Alert::SendableAlerts : public wpi::nt::NTSendable,
return m_alerts[static_cast<int32_t>(type)];
default:
throw WPILIB_MakeError(wpi::err::InvalidParameter,
"Invalid Alert Type: {}", type);
"Invalid Alert Type: {}", type);
}
}

11
wpilibc/src/main/native/cpp/util/Preferences.cpp
View File

@@ -29,10 +29,13 @@ struct Instance {
std::shared_ptr<wpi::nt::NetworkTable> table{
wpi::nt::NetworkTableInstance::GetDefault().GetTable(kTableName)};
wpi::nt::StringPublisher typePublisher{table->GetStringTopic(".type").PublishEx(
wpi::nt::StringTopic::kTypeString, {{"SmartDashboard", kSmartDashboardType}})};
wpi::nt::MultiSubscriber tableSubscriber{wpi::nt::NetworkTableInstance::GetDefault(),
{{fmt::format("{}/", table->GetPath())}}};
wpi::nt::StringPublisher typePublisher{
table->GetStringTopic(".type").PublishEx(
wpi::nt::StringTopic::kTypeString,
{{"SmartDashboard", kSmartDashboardType}})};
wpi::nt::MultiSubscriber tableSubscriber{
wpi::nt::NetworkTableInstance::GetDefault(),
{{fmt::format("{}/", table->GetPath())}}};
wpi::nt::NetworkTableListener listener;
};
} // namespace

3
wpilibc/src/main/native/cppcs/RobotBase.cpp
View File

@@ -202,7 +202,8 @@ RobotBase::RobotBase() {
std::this_thread::sleep_for(10ms);
++count;
if (count > 100) {
wpi::util::print(stderr, "timed out while waiting for NT server to start\n");
wpi::util::print(stderr,
"timed out while waiting for NT server to start\n");
break;
}
}

6
wpilibc/src/main/native/include/wpi/ExpansionHubServo.hpp
View File

@@ -84,7 +84,8 @@ class ExpansionHubServo {
* @param minAngle Minimum angle
* @param maxAngle Maximum angle
*/
void SetAngleRange(wpi::units::degree_t minAngle, wpi::units::degree_t maxAngle);
void SetAngleRange(wpi::units::degree_t minAngle,
wpi::units::degree_t maxAngle);
/**
* Sets the PWM range for the servo.
@@ -95,7 +96,8 @@ class ExpansionHubServo {
* @param minPwm Minimum PWM
* @param maxPwm Maximum PWM
*/
void SetPWMRange(wpi::units::microsecond_t minPwm, wpi::units::microsecond_t maxPwm);
void SetPWMRange(wpi::units::microsecond_t minPwm,
wpi::units::microsecond_t maxPwm);
/**
* Sets whether the servo is reversed.

3
wpilibc/src/main/native/include/wpi/drive/MecanumDrive.hpp
View File

@@ -139,7 +139,8 @@ class MecanumDrive : public RobotDriveBase,
* @param zRotation The robot's rotation rate around the Z axis [-1.0..1.0].
* Counterclockwise is positive.
*/
void DrivePolar(double magnitude, wpi::math::Rotation2d angle, double zRotation);
void DrivePolar(double magnitude, wpi::math::Rotation2d angle,
double zRotation);
/**
* Cartesian inverse kinematics for Mecanum platform.

3
wpilibc/src/main/native/include/wpi/driverstation/DriverStation.hpp
View File

@@ -79,7 +79,8 @@ class DriverStation final {
* @return The angle clockwise from straight up, or std::nullopt if the
* POVDirection is kCenter.
*/
static constexpr std::optional<wpi::math::Rotation2d> GetAngle(POVDirection angle) {
static constexpr std::optional<wpi::math::Rotation2d> GetAngle(
POVDirection angle) {
switch (angle) {
case kCenter:
return std::nullopt;

5
wpilibc/src/main/native/include/wpi/event/NetworkBooleanEvent.hpp
View File

@@ -14,7 +14,7 @@ class BooleanSubscriber;
class BooleanTopic;
class NetworkTable;
class NetworkTableInstance;
} // namespace nt
} // namespace wpi::nt
namespace wpi {
/**
@@ -50,7 +50,8 @@ class NetworkBooleanEvent : public BooleanEvent {
* @param table The NetworkTable that contains the topic
* @param topicName The topic name within the table that contains the value
*/
NetworkBooleanEvent(EventLoop* loop, std::shared_ptr<wpi::nt::NetworkTable> table,
NetworkBooleanEvent(EventLoop* loop,
std::shared_ptr<wpi::nt::NetworkTable> table,
std::string_view topicName);
/**

5
wpilibc/src/main/native/include/wpi/hardware/accelerometer/AnalogAccelerometer.hpp
View File

@@ -19,8 +19,9 @@ namespace wpi {
* sensors have multiple axis and can be treated as multiple devices. Each is
* calibrated by finding the center value over a period of time.
*/
class AnalogAccelerometer : public wpi::util::Sendable,
public wpi::util::SendableHelper<AnalogAccelerometer> {
class AnalogAccelerometer
: public wpi::util::Sendable,
public wpi::util::SendableHelper<AnalogAccelerometer> {
public:
/**
* Create a new instance of an accelerometer.

3
wpilibc/src/main/native/include/wpi/hardware/led/LEDPattern.hpp
View File

@@ -131,7 +131,8 @@ class LEDPattern {
*
* <pre>
* // LEDs per meter, a known value taken from the spec sheet of our
* particular LED strip wpi::units::meter_t LED_SPACING = wpi::units::meter_t{1 /60.0};
* particular LED strip wpi::units::meter_t LED_SPACING =
* wpi::units::meter_t{1 /60.0};
*
* wpi::LEDPattern rainbow = wpi::LEDPattern::Rainbow();
* wpi::LEDPattern scrollingRainbow =

9
wpilibc/src/main/native/include/wpi/hardware/motor/PWMMotorController.hpp
View File

@@ -28,10 +28,11 @@ WPI_IGNORE_DEPRECATED
/**
* Common base class for all PWM Motor Controllers.
*/
class PWMMotorController : public MotorController,
public MotorSafety,
public wpi::util::Sendable,
public wpi::util::SendableHelper<PWMMotorController> {
class PWMMotorController
: public MotorController,
public MotorSafety,
public wpi::util::Sendable,
public wpi::util::SendableHelper<PWMMotorController> {
public:
PWMMotorController(PWMMotorController&&) = default;
PWMMotorController& operator=(PWMMotorController&&) = default;

3
wpilibc/src/main/native/include/wpi/hardware/pneumatic/PneumaticsBase.hpp
View File

@@ -228,7 +228,8 @@ class PneumaticsBase {
* @return The pressure read by an analog pressure sensor on the
* specified analog input channel.
*/
virtual wpi::units::pounds_per_square_inch_t GetPressure(int channel) const = 0;
virtual wpi::units::pounds_per_square_inch_t GetPressure(
int channel) const = 0;
/**
* Create a solenoid object for the specified channel.

3
wpilibc/src/main/native/include/wpi/hardware/pneumatic/Solenoid.hpp
View File

@@ -22,7 +22,8 @@ namespace wpi {
* The Solenoid class is typically used for pneumatics solenoids, but could be
* used for any device within the current spec of the module.
*/
class Solenoid : public wpi::util::Sendable, public wpi::util::SendableHelper<Solenoid> {
class Solenoid : public wpi::util::Sendable,
public wpi::util::SendableHelper<Solenoid> {
public:
/**
* Constructs a solenoid for a specified module and type.

3
wpilibc/src/main/native/include/wpi/hardware/power/PowerDistribution.hpp
View File

@@ -346,7 +346,8 @@ class PowerDistribution : public wpi::util::Sendable,
void InitSendable(wpi::util::SendableBuilder& builder) override;
private:
wpi::hal::Handle<HAL_PowerDistributionHandle, HAL_CleanPowerDistribution> m_handle;
wpi::hal::Handle<HAL_PowerDistributionHandle, HAL_CleanPowerDistribution>
m_handle;
int m_module;
};

3
wpilibc/src/main/native/include/wpi/hardware/range/SharpIR.hpp
View File

@@ -12,7 +12,8 @@
namespace wpi {
class SharpIR : public wpi::util::Sendable, public wpi::util::SendableHelper<SharpIR> {
class SharpIR : public wpi::util::Sendable,
public wpi::util::SendableHelper<SharpIR> {
public:
/**
* Sharp GP2Y0A02YK0F is an analog IR sensor capable of measuring

5
wpilibc/src/main/native/include/wpi/hardware/rotation/AnalogPotentiometer.hpp
View File

@@ -18,8 +18,9 @@ namespace wpi {
* units you choose, by way of the scaling and offset constants passed to the
* constructor.
*/
class AnalogPotentiometer : public wpi::util::Sendable,
public wpi::util::SendableHelper<AnalogPotentiometer> {
class AnalogPotentiometer
: public wpi::util::Sendable,
public wpi::util::SendableHelper<AnalogPotentiometer> {
public:
/**
* Construct an Analog Potentiometer object from a channel number.

3
wpilibc/src/main/native/include/wpi/hardware/rotation/DutyCycle.hpp
View File

@@ -21,7 +21,8 @@ namespace wpi {
* low in that frequency. These can be attached to any SmartIO.
*
*/
class DutyCycle : public wpi::util::Sendable, public wpi::util::SendableHelper<DutyCycle> {
class DutyCycle : public wpi::util::Sendable,
public wpi::util::SendableHelper<DutyCycle> {
public:
/**
* Constructs a DutyCycle input from a smartio channel.

3
wpilibc/src/main/native/include/wpi/opmode/TimedRobot.hpp
View File

@@ -123,7 +123,8 @@ class TimedRobot : public IterativeRobotBase {
std::chrono::microseconds m_startTime;
uint64_t m_loopStartTimeUs = 0;
wpi::util::priority_queue<Callback, std::vector<Callback>, std::greater<Callback>>
wpi::util::priority_queue<Callback, std::vector<Callback>,
std::greater<Callback>>
m_callbacks;
};

9
wpilibc/src/main/native/include/wpi/simulation/BatterySim.hpp
View File

@@ -31,9 +31,9 @@ class BatterySim {
* @param currents The currents drawn from the battery.
* @return The battery's voltage under load.
*/
static wpi::units::volt_t Calculate(wpi::units::volt_t nominalVoltage,
wpi::units::ohm_t resistance,
std::span<const wpi::units::ampere_t> currents) {
static wpi::units::volt_t Calculate(
wpi::units::volt_t nominalVoltage, wpi::units::ohm_t resistance,
std::span<const wpi::units::ampere_t> currents) {
return std::max(0_V, nominalVoltage - std::accumulate(currents.begin(),
currents.end(), 0_A) *
resistance);
@@ -69,7 +69,8 @@ class BatterySim {
* @param currents The currents drawn from the battery.
* @return The battery's voltage under load.
*/
static wpi::units::volt_t Calculate(std::span<const wpi::units::ampere_t> currents) {
static wpi::units::volt_t Calculate(
std::span<const wpi::units::ampere_t> currents) {
return Calculate(12_V, 0.02_Ohm, currents);
}

7
wpilibc/src/main/native/include/wpi/simulation/DCMotorSim.hpp
View File

@@ -24,13 +24,14 @@ class DCMotorSim : public LinearSystemSim<2, 1, 2> {
*
* @param plant The linear system representing the DC motor. This
* system can be created with wpi::math::LinearSystemId::DCMotorSystem(). If
* wpi::math::LinearSystemId::DCMotorSystem(kV, kA) is used, the distance unit must be
* radians.
* wpi::math::LinearSystemId::DCMotorSystem(kV, kA) is used, the distance unit
* must be radians.
* @param gearbox The type of and number of motors in the DC motor
* gearbox.
* @param measurementStdDevs The standard deviation of the measurement noise.
*/
DCMotorSim(const wpi::math::LinearSystem<2, 1, 2>& plant, const wpi::math::DCMotor& gearbox,
DCMotorSim(const wpi::math::LinearSystem<2, 1, 2>& plant,
const wpi::math::DCMotor& gearbox,
const std::array<double, 2>& measurementStdDevs = {0.0, 0.0});
using LinearSystemSim::SetState;

50
wpilibc/src/main/native/include/wpi/simulation/DifferentialDrivetrainSim.hpp
View File

@@ -20,12 +20,13 @@ class DifferentialDrivetrainSim {
/**
* Creates a simulated differential drivetrain.
*
* @param plant The wpi::math::LinearSystem representing the robot's drivetrain. This
* system can be created with
* @param plant The wpi::math::LinearSystem representing the robot's
* drivetrain. This system can be created with
* wpi::math::LinearSystemId::DrivetrainVelocitySystem() or
* wpi::math::LinearSystemId::IdentifyDrivetrainSystem().
* @param trackwidth The robot's trackwidth.
* @param driveMotor A wpi::math::DCMotor representing the left side of the drivetrain.
* @param driveMotor A wpi::math::DCMotor representing the left side of the
* drivetrain.
* @param gearingRatio The gearingRatio ratio of the left side, as output over
* input. This must be the same ratio as the ratio used to
* identify or create the plant.
@@ -41,13 +42,15 @@ class DifferentialDrivetrainSim {
*/
DifferentialDrivetrainSim(
wpi::math::LinearSystem<2, 2, 2> plant, wpi::units::meter_t trackwidth,
wpi::math::DCMotor driveMotor, double gearingRatio, wpi::units::meter_t wheelRadius,
wpi::math::DCMotor driveMotor, double gearingRatio,
wpi::units::meter_t wheelRadius,
const std::array<double, 7>& measurementStdDevs = {});
/**
* Creates a simulated differential drivetrain.
*
* @param driveMotor A wpi::math::DCMotor representing the left side of the drivetrain.
* @param driveMotor A wpi::math::DCMotor representing the left side of the
* drivetrain.
* @param gearing The gearing on the drive between motor and wheel, as
* output over input. This must be the same ratio as the
* ratio used to identify or create the plant.
@@ -67,9 +70,9 @@ class DifferentialDrivetrainSim {
* starting point.
*/
DifferentialDrivetrainSim(
wpi::math::DCMotor driveMotor, double gearing, wpi::units::kilogram_square_meter_t J,
wpi::units::kilogram_t mass, wpi::units::meter_t wheelRadius,
wpi::units::meter_t trackwidth,
wpi::math::DCMotor driveMotor, double gearing,
wpi::units::kilogram_square_meter_t J, wpi::units::kilogram_t mass,
wpi::units::meter_t wheelRadius, wpi::units::meter_t trackwidth,
const std::array<double, 7>& measurementStdDevs = {});
/**
@@ -88,7 +91,8 @@ class DifferentialDrivetrainSim {
* @param leftVoltage The left voltage.
* @param rightVoltage The right voltage.
*/
void SetInputs(wpi::units::volt_t leftVoltage, wpi::units::volt_t rightVoltage);
void SetInputs(wpi::units::volt_t leftVoltage,
wpi::units::volt_t rightVoltage);
/**
* Sets the gearing reduction on the drivetrain. This is commonly used for
@@ -101,8 +105,8 @@ class DifferentialDrivetrainSim {
/**
* Updates the simulation.
*
* @param dt The time that's passed since the last Update(wpi::units::second_t)
* call.
* @param dt The time that's passed since the last
* Update(wpi::units::second_t) call.
*/
void Update(wpi::units::second_t dt);
@@ -193,7 +197,8 @@ class DifferentialDrivetrainSim {
* @param u The input.
* @return The state derivative with respect to time.
*/
wpi::math::Vectord<7> Dynamics(const wpi::math::Vectord<7>& x, const Eigen::Vector2d& u);
wpi::math::Vectord<7> Dynamics(const wpi::math::Vectord<7>& x,
const Eigen::Vector2d& u);
class State {
public:
@@ -234,14 +239,17 @@ class DifferentialDrivetrainSim {
class KitbotMotor {
public:
/// One CIM motor per drive side.
static constexpr wpi::math::DCMotor SingleCIMPerSide = wpi::math::DCMotor::CIM(1);
static constexpr wpi::math::DCMotor SingleCIMPerSide =
wpi::math::DCMotor::CIM(1);
/// Two CIM motors per drive side.
static constexpr wpi::math::DCMotor DualCIMPerSide = wpi::math::DCMotor::CIM(2);
static constexpr wpi::math::DCMotor DualCIMPerSide =
wpi::math::DCMotor::CIM(2);
/// One Mini CIM motor per drive side.
static constexpr wpi::math::DCMotor SingleMiniCIMPerSide =
wpi::math::DCMotor::MiniCIM(1);
/// Two Mini CIM motors per drive side.
static constexpr wpi::math::DCMotor DualMiniCIMPerSide = wpi::math::DCMotor::MiniCIM(2);
static constexpr wpi::math::DCMotor DualMiniCIMPerSide =
wpi::math::DCMotor::MiniCIM(2);
/// One Falcon 500 motor per drive side.
static constexpr wpi::math::DCMotor SingleFalcon500PerSide =
wpi::math::DCMotor::Falcon500(1);
@@ -249,9 +257,11 @@ class DifferentialDrivetrainSim {
static constexpr wpi::math::DCMotor DualFalcon500PerSide =
wpi::math::DCMotor::Falcon500(2);
/// One NEO motor per drive side.
static constexpr wpi::math::DCMotor SingleNEOPerSide = wpi::math::DCMotor::NEO(1);
static constexpr wpi::math::DCMotor SingleNEOPerSide =
wpi::math::DCMotor::NEO(1);
/// Two NEO motors per drive side.
static constexpr wpi::math::DCMotor DualNEOPerSide = wpi::math::DCMotor::NEO(2);
static constexpr wpi::math::DCMotor DualNEOPerSide =
wpi::math::DCMotor::NEO(2);
};
/**
@@ -285,9 +295,9 @@ class DifferentialDrivetrainSim {
const std::array<double, 7>& measurementStdDevs = {}) {
// MOI estimation -- note that I = mr² for point masses
wpi::units::kilogram_square_meter_t batteryMoi = 12.5_lb * 10_in * 10_in;
wpi::units::kilogram_square_meter_t gearboxMoi = (2.8_lb + 2.0_lb) *
2 // CIM plus toughbox per side
* (26_in / 2) * (26_in / 2);
wpi::units::kilogram_square_meter_t gearboxMoi =
(2.8_lb + 2.0_lb) * 2 // CIM plus toughbox per side
* (26_in / 2) * (26_in / 2);
return DifferentialDrivetrainSim{
motor, gearing, batteryMoi + gearboxMoi, 60_lb,

29
wpilibc/src/main/native/include/wpi/simulation/ElevatorSim.hpp
View File

@@ -19,12 +19,13 @@ namespace wpi::sim {
class ElevatorSim : public LinearSystemSim<2, 1, 2> {
public:
template <typename Distance>
using Velocity_t = wpi::units::unit_t<
wpi::units::compound_unit<Distance, wpi::units::inverse<wpi::units::seconds>>>;
using Velocity_t = wpi::units::unit_t<wpi::units::compound_unit<
Distance, wpi::units::inverse<wpi::units::seconds>>>;
template <typename Distance>
using Acceleration_t = wpi::units::unit_t<wpi::units::compound_unit<
wpi::units::compound_unit<Distance, wpi::units::inverse<wpi::units::seconds>>,
wpi::units::compound_unit<Distance,
wpi::units::inverse<wpi::units::seconds>>,
wpi::units::inverse<wpi::units::seconds>>>;
/**
@@ -41,9 +42,10 @@ class ElevatorSim : public LinearSystemSim<2, 1, 2> {
* @param startingHeight The starting height of the elevator.
* @param measurementStdDevs The standard deviation of the measurements.
*/
ElevatorSim(const wpi::math::LinearSystem<2, 1, 2>& plant, const wpi::math::DCMotor& gearbox,
wpi::units::meter_t minHeight, wpi::units::meter_t maxHeight,
bool simulateGravity, wpi::units::meter_t startingHeight,
ElevatorSim(const wpi::math::LinearSystem<2, 1, 2>& plant,
const wpi::math::DCMotor& gearbox, wpi::units::meter_t minHeight,
wpi::units::meter_t maxHeight, bool simulateGravity,
wpi::units::meter_t startingHeight,
const std::array<double, 2>& measurementStdDevs = {0.0, 0.0});
/**
@@ -63,9 +65,10 @@ class ElevatorSim : public LinearSystemSim<2, 1, 2> {
* @param measurementStdDevs The standard deviation of the measurements.
*/
ElevatorSim(const wpi::math::DCMotor& gearbox, double gearing,
wpi::units::kilogram_t carriageMass, wpi::units::meter_t drumRadius,
wpi::units::meter_t minHeight, wpi::units::meter_t maxHeight,
bool simulateGravity, wpi::units::meter_t startingHeight,
wpi::units::kilogram_t carriageMass,
wpi::units::meter_t drumRadius, wpi::units::meter_t minHeight,
wpi::units::meter_t maxHeight, bool simulateGravity,
wpi::units::meter_t startingHeight,
const std::array<double, 2>& measurementStdDevs = {0.0, 0.0});
/**
@@ -98,7 +101,8 @@ class ElevatorSim : public LinearSystemSim<2, 1, 2> {
* @param position The new position
* @param velocity The new velocity
*/
void SetState(wpi::units::meter_t position, wpi::units::meters_per_second_t velocity);
void SetState(wpi::units::meter_t position,
wpi::units::meters_per_second_t velocity);
/**
* Returns whether the elevator would hit the lower limit.
@@ -166,8 +170,9 @@ class ElevatorSim : public LinearSystemSim<2, 1, 2> {
* @param u The system inputs (voltage).
* @param dt The time difference between controller updates.
*/
wpi::math::Vectord<2> UpdateX(const wpi::math::Vectord<2>& currentXhat, const wpi::math::Vectord<1>& u,
wpi::units::second_t dt) override;
wpi::math::Vectord<2> UpdateX(const wpi::math::Vectord<2>& currentXhat,
const wpi::math::Vectord<1>& u,
wpi::units::second_t dt) override;
private:
wpi::math::DCMotor m_gearbox;

3
wpilibc/src/main/native/include/wpi/simulation/FlywheelSim.hpp
View File

@@ -29,7 +29,8 @@ class FlywheelSim : public LinearSystemSim<1, 1, 1> {
* gearbox.
* @param measurementStdDevs The standard deviation of the measurement noise.
*/
FlywheelSim(const wpi::math::LinearSystem<1, 1, 1>& plant, const wpi::math::DCMotor& gearbox,
FlywheelSim(const wpi::math::LinearSystem<1, 1, 1>& plant,
const wpi::math::DCMotor& gearbox,
const std::array<double, 1>& measurementStdDevs = {0.0});
using LinearSystemSim::SetState;

6
wpilibc/src/main/native/include/wpi/simulation/LinearSystemSim.hpp
View File

@@ -131,9 +131,9 @@ class LinearSystemSim {
* @param u The system inputs (usually voltage).
* @param dt The time difference between controller updates.
*/
virtual wpi::math::Vectord<States> UpdateX(const wpi::math::Vectord<States>& currentXhat,
const wpi::math::Vectord<Inputs>& u,
wpi::units::second_t dt) {
virtual wpi::math::Vectord<States> UpdateX(
const wpi::math::Vectord<States>& currentXhat,
const wpi::math::Vectord<Inputs>& u, wpi::units::second_t dt) {
return m_plant.CalculateX(currentXhat, u, dt);
}

24
wpilibc/src/main/native/include/wpi/simulation/SingleJointedArmSim.hpp
View File

@@ -37,7 +37,8 @@ class SingleJointedArmSim : public LinearSystemSim<2, 1, 2> {
*/
SingleJointedArmSim(const wpi::math::LinearSystem<2, 1, 2>& system,
const wpi::math::DCMotor& gearbox, double gearing,
wpi::units::meter_t armLength, wpi::units::radian_t minAngle,
wpi::units::meter_t armLength,
wpi::units::radian_t minAngle,
wpi::units::radian_t maxAngle, bool simulateGravity,
wpi::units::radian_t startingAngle,
const std::array<double, 2>& measurementStdDevs = {0.0,
@@ -57,13 +58,12 @@ class SingleJointedArmSim : public LinearSystemSim<2, 1, 2> {
* @param startingAngle The initial position of the arm.
* @param measurementStdDevs The standard deviation of the measurement noise.
*/
SingleJointedArmSim(const wpi::math::DCMotor& gearbox, double gearing,
wpi::units::kilogram_square_meter_t moi,
wpi::units::meter_t armLength, wpi::units::radian_t minAngle,
wpi::units::radian_t maxAngle, bool simulateGravity,
wpi::units::radian_t startingAngle,
const std::array<double, 2>& measurementStdDevs = {0.0,
0.0});
SingleJointedArmSim(
const wpi::math::DCMotor& gearbox, double gearing,
wpi::units::kilogram_square_meter_t moi, wpi::units::meter_t armLength,
wpi::units::radian_t minAngle, wpi::units::radian_t maxAngle,
bool simulateGravity, wpi::units::radian_t startingAngle,
const std::array<double, 2>& measurementStdDevs = {0.0, 0.0});
using LinearSystemSim::SetState;
@@ -74,7 +74,8 @@ class SingleJointedArmSim : public LinearSystemSim<2, 1, 2> {
* @param angle The new angle.
* @param velocity The new angular velocity.
*/
void SetState(wpi::units::radian_t angle, wpi::units::radians_per_second_t velocity);
void SetState(wpi::units::radian_t angle,
wpi::units::radians_per_second_t velocity);
/**
* Returns whether the arm would hit the lower limit.
@@ -156,8 +157,9 @@ class SingleJointedArmSim : public LinearSystemSim<2, 1, 2> {
* @param u The system inputs (voltage).
* @param dt The time difference between controller updates.
*/
wpi::math::Vectord<2> UpdateX(const wpi::math::Vectord<2>& currentXhat, const wpi::math::Vectord<1>& u,
wpi::units::second_t dt) override;
wpi::math::Vectord<2> UpdateX(const wpi::math::Vectord<2>& currentXhat,
const wpi::math::Vectord<1>& u,
wpi::units::second_t dt) override;
private:
wpi::units::meter_t m_armLen;

6
wpilibc/src/main/native/include/wpi/smartdashboard/Field2d.hpp
View File

@@ -38,7 +38,8 @@ namespace wpi {
* also be shown by using the GetObject() function. Other objects can
* also have multiple poses (which will show the object at multiple locations).
*/
class Field2d : public wpi::nt::NTSendable, public wpi::util::SendableHelper<Field2d> {
class Field2d : public wpi::nt::NTSendable,
public wpi::util::SendableHelper<Field2d> {
public:
using Entry = size_t;
@@ -61,7 +62,8 @@ class Field2d : public wpi::nt::NTSendable, public wpi::util::SendableHelper<Fie
* @param y Y location
* @param rotation rotation
*/
void SetRobotPose(wpi::units::meter_t x, wpi::units::meter_t y, wpi::math::Rotation2d rotation);
void SetRobotPose(wpi::units::meter_t x, wpi::units::meter_t y,
wpi::math::Rotation2d rotation);
/**
* Get the robot pose.

6
wpilibc/src/main/native/include/wpi/smartdashboard/FieldObject2d.hpp
View File

@@ -52,7 +52,8 @@ class FieldObject2d {
* @param y Y location
* @param rotation rotation
*/
void SetPose(wpi::units::meter_t x, wpi::units::meter_t y, wpi::math::Rotation2d rotation);
void SetPose(wpi::units::meter_t x, wpi::units::meter_t y,
wpi::math::Rotation2d rotation);
/**
* Get the pose.
@@ -97,7 +98,8 @@ class FieldObject2d {
* @param out output wpi::util::SmallVector to hold 2D poses
* @return span referring to output wpi::util::SmallVector
*/
std::span<const wpi::math::Pose2d> GetPoses(wpi::util::SmallVectorImpl<wpi::math::Pose2d>& out) const;
std::span<const wpi::math::Pose2d> GetPoses(
wpi::util::SmallVectorImpl<wpi::math::Pose2d>& out) const;
private:
void UpdateEntry(bool setDefault = false);

16
wpilibc/src/main/native/include/wpi/smartdashboard/SendableBuilderImpl.hpp
View File

@@ -155,7 +155,8 @@ class SendableBuilderImpl : public wpi::nt::NTSendableBuilder {
void AddSmallStringProperty(
std::string_view key,
std::function<std::string_view(wpi::util::SmallVectorImpl<char>& buf)> getter,
std::function<std::string_view(wpi::util::SmallVectorImpl<char>& buf)>
getter,
std::function<void(std::string_view)> setter) override;
void AddSmallBooleanArrayProperty(
@@ -173,26 +174,29 @@ class SendableBuilderImpl : public wpi::nt::NTSendableBuilder {
void AddSmallFloatArrayProperty(
std::string_view key,
std::function<std::span<const float>(wpi::util::SmallVectorImpl<float>& buf)>
std::function<
std::span<const float>(wpi::util::SmallVectorImpl<float>& buf)>
getter,
std::function<void(std::span<const float>)> setter) override;
void AddSmallDoubleArrayProperty(
std::string_view key,
std::function<std::span<const double>(wpi::util::SmallVectorImpl<double>& buf)>
std::function<
std::span<const double>(wpi::util::SmallVectorImpl<double>& buf)>
getter,
std::function<void(std::span<const double>)> setter) override;
void AddSmallStringArrayProperty(
std::string_view key,
std::function<
std::span<const std::string>(wpi::util::SmallVectorImpl<std::string>& buf)>
std::function<std::span<const std::string>(
wpi::util::SmallVectorImpl<std::string>& buf)>
getter,
std::function<void(std::span<const std::string>)> setter) override;
void AddSmallRawProperty(
std::string_view key, std::string_view typeString,
std::function<std::span<uint8_t>(wpi::util::SmallVectorImpl<uint8_t>& buf)>
std::function<
std::span<uint8_t>(wpi::util::SmallVectorImpl<uint8_t>& buf)>
getter,
std::function<void(std::span<const uint8_t>)> setter) override;

5
wpilibc/src/main/native/include/wpi/smartdashboard/SendableChooserBase.hpp
View File

@@ -19,8 +19,9 @@ namespace wpi {
* It contains static, non-templated variables to avoid their duplication in the
* template class.
*/
class SendableChooserBase : public wpi::util::Sendable,
public wpi::util::SendableHelper<SendableChooserBase> {
class SendableChooserBase
: public wpi::util::Sendable,
public wpi::util::SendableHelper<SendableChooserBase> {
public:
SendableChooserBase();
~SendableChooserBase() override = default;

2
wpilibc/src/main/native/include/wpi/smartdashboard/SmartDashboard.hpp
View File

@@ -16,7 +16,7 @@
namespace wpi::util {
class Sendable;
} // namespace wpi
} // namespace wpi::util
namespace wpi {

6
wpilibc/src/main/native/include/wpi/sysid/SysIdRoutineLog.hpp
View File

@@ -116,7 +116,8 @@ class SysIdRoutineLog {
* @param acceleration The linear acceleration to record.
* @return The motor log (for call chaining).
*/
MotorLog& acceleration(wpi::units::meters_per_second_squared_t acceleration) {
MotorLog& acceleration(
wpi::units::meters_per_second_squared_t acceleration) {
return value("acceleration", acceleration.value(), acceleration.name());
}
@@ -128,7 +129,8 @@ class SysIdRoutineLog {
* @param acceleration The angular acceleration to record.
* @return The motor log (for call chaining).
*/
MotorLog& acceleration(wpi::units::turns_per_second_squared_t acceleration) {
MotorLog& acceleration(
wpi::units::turns_per_second_squared_t acceleration) {
return value("acceleration", acceleration.value(), acceleration.name());
}

6
wpilibc/src/main/native/include/wpi/system/DataLogManager.hpp
View File

@@ -26,9 +26,9 @@ namespace wpi {
* connected and provides a match number, the log file is renamed to
* "WPILIB_yyyyMMdd_HHmmss_{event}_{match}.wpilog".
*
* On startup, all existing WPILIB_TBD log files are deleted. If there is less than
* 50 MB of free space on the target storage, WPILIB_ log files are deleted (oldest
* to newest) until there is 50 MB free OR there are 10 files remaining.
* On startup, all existing WPILIB_TBD log files are deleted. If there is less
* than 50 MB of free space on the target storage, WPILIB_ log files are deleted
* (oldest to newest) until there is 50 MB free OR there are 10 files remaining.
*
* By default, all NetworkTables value changes are stored to the data log.
*/

10
wpilibc/src/main/native/include/wpi/system/Errors.hpp
View File

@@ -134,7 +134,7 @@ namespace warn {
* @param[out] status error code
* @param[in] format error message format
*/
#define WPILIB_ReportError(status, format, ...) \
#define WPILIB_ReportError(status, format, ...) \
do { \
if ((status) != 0) { \
::wpi::ReportError(status, __FILE__, __LINE__, __FUNCTION__, \
@@ -147,7 +147,7 @@ namespace warn {
*
* @param[in] format error message format
*/
#define WPILIB_ReportWarning(format, ...) \
#define WPILIB_ReportWarning(format, ...) \
do { \
::wpi::ReportError(::wpi::warn::Warning, __FILE__, __LINE__, __FUNCTION__, \
format __VA_OPT__(, ) __VA_ARGS__); \
@@ -161,7 +161,7 @@ namespace warn {
* @param[in] format error message format
* @return runtime error object
*/
#define WPILIB_MakeError(status, format, ...) \
#define WPILIB_MakeError(status, format, ...) \
::wpi::MakeError(status, __FILE__, __LINE__, __FUNCTION__, \
format __VA_OPT__(, ) __VA_ARGS__)
@@ -172,7 +172,7 @@ namespace warn {
* @param[out] status error code
* @param[in] format error message format
*/
#define WPILIB_CheckErrorStatus(status, format, ...) \
#define WPILIB_CheckErrorStatus(status, format, ...) \
do { \
if ((status) < 0) { \
throw ::wpi::MakeError(status, __FILE__, __LINE__, __FUNCTION__, \
@@ -183,7 +183,7 @@ namespace warn {
} \
} while (0)
#define WPILIB_AssertMessage(condition, format, ...) \
#define WPILIB_AssertMessage(condition, format, ...) \
do { \
if (!(condition)) { \
throw ::wpi::MakeError(::wpi::err::AssertionFailure, __FILE__, __LINE__, \

2
wpilibc/src/main/native/include/wpi/system/ScopedTracer.hpp
View File

@@ -11,7 +11,7 @@
namespace wpi::util {
class raw_ostream;
} // namespace wpi
} // namespace wpi::util
namespace wpi {
/**

5
wpilibc/src/main/native/include/wpi/system/Tracer.hpp
View File

@@ -12,7 +12,7 @@
namespace wpi::util {
class raw_ostream;
} // namespace wpi
} // namespace wpi::util
namespace wpi {
/**
@@ -66,7 +66,8 @@ class Tracer {
static constexpr std::chrono::milliseconds kMinPrintPeriod{1000};
wpi::hal::fpga_clock::time_point m_startTime;
wpi::hal::fpga_clock::time_point m_lastEpochsPrintTime = wpi::hal::fpga_clock::epoch();
wpi::hal::fpga_clock::time_point m_lastEpochsPrintTime =
wpi::hal::fpga_clock::epoch();
wpi::util::StringMap<std::chrono::nanoseconds> m_epochs;
};

3
wpilibc/src/main/native/include/wpi/system/Watchdog.hpp
View File

@@ -34,7 +34,8 @@ class Watchdog {
Watchdog(wpi::units::second_t timeout, std::function<void()> callback);
template <typename Callable, typename Arg, typename... Args>
Watchdog(wpi::units::second_t timeout, Callable&& f, Arg&& arg, Args&&... args)
Watchdog(wpi::units::second_t timeout, Callable&& f, Arg&& arg,
Args&&... args)
: Watchdog(timeout,
std::bind(std::forward<Callable>(f), std::forward<Arg>(arg),
std::forward<Args>(args)...)) {}

13
wpilibc/src/main/native/include/wpi/util/Color.hpp
View File

@@ -782,9 +782,12 @@ class Color {
*/
explicit constexpr Color(std::string_view hexString) {
if (hexString.length() != 7 || !hexString.starts_with("#") ||
!wpi::util::isHexDigit(hexString[1]) || !wpi::util::isHexDigit(hexString[2]) ||
!wpi::util::isHexDigit(hexString[3]) || !wpi::util::isHexDigit(hexString[4]) ||
!wpi::util::isHexDigit(hexString[5]) || !wpi::util::isHexDigit(hexString[6])) {
!wpi::util::isHexDigit(hexString[1]) ||
!wpi::util::isHexDigit(hexString[2]) ||
!wpi::util::isHexDigit(hexString[3]) ||
!wpi::util::isHexDigit(hexString[4]) ||
!wpi::util::isHexDigit(hexString[5]) ||
!wpi::util::isHexDigit(hexString[6])) {
throw std::invalid_argument(
fmt::format("Invalid hex string for Color \"{}\"", hexString));
}
@@ -861,8 +864,8 @@ class Color {
return wpi::util::ct_string<char, std::char_traits<char>, 7>{
{'#', wpi::util::hexdigit(r / 16), wpi::util::hexdigit(r % 16),
wpi::util::hexdigit(g / 16), wpi::util::hexdigit(g % 16), wpi::util::hexdigit(b / 16),
wpi::util::hexdigit(b % 16)}};
wpi::util::hexdigit(g / 16), wpi::util::hexdigit(g % 16),
wpi::util::hexdigit(b / 16), wpi::util::hexdigit(b % 16)}};
}
/// Red component (0-1).

18
wpilibc/src/main/native/include/wpi/util/Color8Bit.hpp
View File

@@ -57,9 +57,12 @@ class Color8Bit {
*/
explicit constexpr Color8Bit(std::string_view hexString) {
if (hexString.length() != 7 || !hexString.starts_with("#") ||
!wpi::util::isHexDigit(hexString[1]) || !wpi::util::isHexDigit(hexString[2]) ||
!wpi::util::isHexDigit(hexString[3]) || !wpi::util::isHexDigit(hexString[4]) ||
!wpi::util::isHexDigit(hexString[5]) || !wpi::util::isHexDigit(hexString[6])) {
!wpi::util::isHexDigit(hexString[1]) ||
!wpi::util::isHexDigit(hexString[2]) ||
!wpi::util::isHexDigit(hexString[3]) ||
!wpi::util::isHexDigit(hexString[4]) ||
!wpi::util::isHexDigit(hexString[5]) ||
!wpi::util::isHexDigit(hexString[6])) {
throw std::invalid_argument(
fmt::format("Invalid hex string for Color \"{}\"", hexString));
}
@@ -87,9 +90,12 @@ class Color8Bit {
*/
static constexpr Color8Bit FromHexString(std::string_view hexString) {
if (hexString.length() != 7 || !hexString.starts_with("#") ||
!wpi::util::isHexDigit(hexString[1]) || !wpi::util::isHexDigit(hexString[2]) ||
!wpi::util::isHexDigit(hexString[3]) || !wpi::util::isHexDigit(hexString[4]) ||
!wpi::util::isHexDigit(hexString[5]) || !wpi::util::isHexDigit(hexString[6])) {
!wpi::util::isHexDigit(hexString[1]) ||
!wpi::util::isHexDigit(hexString[2]) ||
!wpi::util::isHexDigit(hexString[3]) ||
!wpi::util::isHexDigit(hexString[4]) ||
!wpi::util::isHexDigit(hexString[5]) ||
!wpi::util::isHexDigit(hexString[6])) {
throw std::invalid_argument(
fmt::format("Invalid hex string for Color \"{}\"", hexString));
}