mirror of
https://github.com/wpilibsuite/allwpilib
synced 2026-06-24 01:31:46 +00:00
952ebb11ad
For Java, this is as simple as just adding it, as all motors already have an implementation from MotorSafety that is correctly resolved. For C++, I had to override StopMotor in the classes that descend from SafePWM and explicitly call the SafePWM version. RobotDrive now calls StopMotor on each of its SpeedControllers, instead of calling Disable or setting the motor to 0.0 as it was doing previously. Additional small formatting corrections to the previous commit starting this were added. Change-Id: Ie94565394927a910ce74bc628670ac3d658d8df9
94 lines
2.9 KiB
C++
94 lines
2.9 KiB
C++
/*----------------------------------------------------------------------------*/
|
|
/* Copyright (c) FIRST 2008-2016. All Rights Reserved. */
|
|
/* Open Source Software - may be modified and shared by FRC teams. The code */
|
|
/* must be accompanied by the FIRST BSD license file in the root directory of */
|
|
/* the project. */
|
|
/*----------------------------------------------------------------------------*/
|
|
|
|
#include "SD540.h"
|
|
|
|
#include "LiveWindow/LiveWindow.h"
|
|
|
|
/**
|
|
* Note that the SD540 uses the following bounds for PWM values. These values
|
|
* should work reasonably well for
|
|
* most controllers, but if users experience issues such as asymmetric behavior
|
|
* around
|
|
* the deadband or inability to saturate the controller in either direction,
|
|
* calibration is recommended.
|
|
* The calibration procedure can be found in the SD540 User Manual available
|
|
* from Mindsensors.
|
|
*
|
|
* 2.05ms = full "forward"
|
|
* 1.55ms = the "high end" of the deadband range
|
|
* 1.50ms = center of the deadband range (off)
|
|
* 1.44ms = the "low end" of the deadband range
|
|
* 0.94ms = full "reverse"
|
|
*/
|
|
|
|
/**
|
|
* Constructor for a SD540
|
|
* @param channel The PWM channel that the SD540 is attached to. 0-9 are
|
|
* on-board, 10-19 are on the MXP port
|
|
*/
|
|
SD540::SD540(uint32_t channel) : SafePWM(channel) {
|
|
SetBounds(2.05, 1.55, 1.50, 1.44, .94);
|
|
SetPeriodMultiplier(kPeriodMultiplier_1X);
|
|
SetRaw(m_centerPwm);
|
|
SetZeroLatch();
|
|
|
|
HALReport(HALUsageReporting::kResourceType_MindsensorsSD540, GetChannel());
|
|
LiveWindow::GetInstance()->AddActuator("SD540", GetChannel(), this);
|
|
}
|
|
|
|
/**
|
|
* Set the PWM value.
|
|
*
|
|
* The PWM value is set using a range of -1.0 to 1.0, appropriately
|
|
* scaling the value for the FPGA.
|
|
*
|
|
* @param speed The speed value between -1.0 and 1.0 to set.
|
|
* @param syncGroup Unused interface.
|
|
*/
|
|
void SD540::Set(float speed, uint8_t syncGroup) {
|
|
SetSpeed(m_isInverted ? -speed : speed);
|
|
}
|
|
|
|
/**
|
|
* Get the recently set value of the PWM.
|
|
*
|
|
* @return The most recently set value for the PWM between -1.0 and 1.0.
|
|
*/
|
|
float SD540::Get() const { return GetSpeed(); }
|
|
|
|
/**
|
|
* Common interface for inverting direction of a speed controller.
|
|
* @param isInverted The state of inversion, true is inverted.
|
|
*/
|
|
void SD540::SetInverted(bool isInverted) { m_isInverted = isInverted; }
|
|
|
|
/**
|
|
* Common interface for the inverting direction of a speed controller.
|
|
*
|
|
* @return isInverted The state of inversion, true is inverted.
|
|
*
|
|
*/
|
|
bool SD540::GetInverted() const { return m_isInverted; }
|
|
|
|
/**
|
|
* Common interface for disabling a motor.
|
|
*/
|
|
void SD540::Disable() { SetRaw(kPwmDisabled); }
|
|
|
|
/**
|
|
* Write out the PID value as seen in the PIDOutput base object.
|
|
*
|
|
* @param output Write out the PWM value as was found in the PIDController
|
|
*/
|
|
void SD540::PIDWrite(float output) { Set(output); }
|
|
|
|
/**
|
|
* Common interface to stop the motor until Set is called again.
|
|
*/
|
|
void SD540::StopMotor() { this->SafePWM::StopMotor(); }
|