WPILibC++
2018.4.1-20180924001740-1197-g467c9fd
|
A class for driving Mecanum drive platforms. More...
#include <MecanumDrive.h>
Public Member Functions | |
MecanumDrive (SpeedController &frontLeftMotor, SpeedController &rearLeftMotor, SpeedController &frontRightMotor, SpeedController &rearRightMotor) | |
Construct a MecanumDrive. More... | |
MecanumDrive (const MecanumDrive &)=delete | |
MecanumDrive & | operator= (const MecanumDrive &)=delete |
void | DriveCartesian (double ySpeed, double xSpeed, double zRotation, double gyroAngle=0.0) |
Drive method for Mecanum platform. More... | |
void | DrivePolar (double magnitude, double angle, double zRotation) |
Drive method for Mecanum platform. More... | |
bool | IsRightSideInverted () const |
Gets if the power sent to the right side of the drivetrain is multipled by -1. More... | |
void | SetRightSideInverted (bool rightSideInverted) |
Sets if the power sent to the right side of the drivetrain should be multipled by -1. More... | |
void | StopMotor () override |
void | GetDescription (wpi::raw_ostream &desc) const override |
void | InitSendable (SendableBuilder &builder) override |
Initializes this Sendable object. More... | |
![]() | |
RobotDriveBase (const RobotDriveBase &)=delete | |
RobotDriveBase & | operator= (const RobotDriveBase &)=delete |
void | SetDeadband (double deadband) |
Sets the deadband applied to the drive inputs (e.g., joystick values). More... | |
void | SetMaxOutput (double maxOutput) |
Configure the scaling factor for using RobotDrive with motor controllers in a mode other than PercentVbus or to limit the maximum output. More... | |
void | FeedWatchdog () |
Feed the motor safety object. More... | |
void | SetExpiration (double timeout) override |
double | GetExpiration () const override |
bool | IsAlive () const override |
bool | IsSafetyEnabled () const override |
void | SetSafetyEnabled (bool enabled) override |
![]() | |
SendableBase (bool addLiveWindow=true) | |
Creates an instance of the sensor base. More... | |
std::string | GetName () const final |
Gets the name of this Sendable object. More... | |
void | SetName (const wpi::Twine &name) final |
Sets the name of this Sendable object. More... | |
std::string | GetSubsystem () const final |
Gets the subsystem name of this Sendable object. More... | |
void | SetSubsystem (const wpi::Twine &subsystem) final |
Sets the subsystem name of this Sendable object. More... | |
![]() | |
void | SetName (const wpi::Twine &subsystem, const wpi::Twine &name) |
Sets both the subsystem name and device name of this Sendable object. More... | |
Additional Inherited Members | |
![]() | |
enum | MotorType { kFrontLeft = 0, kFrontRight = 1, kRearLeft = 2, kRearRight = 3, kLeft = 0, kRight = 1, kBack = 2 } |
The location of a motor on the robot for the purpose of driving. | |
![]() | |
double | Limit (double number) |
Limit motor values to the -1.0 to +1.0 range. | |
double | ApplyDeadband (double number, double deadband) |
Returns 0.0 if the given value is within the specified range around zero. More... | |
void | Normalize (wpi::MutableArrayRef< double > wheelSpeeds) |
Normalize all wheel speeds if the magnitude of any wheel is greater than 1.0. | |
![]() | |
void | AddChild (std::shared_ptr< Sendable > child) |
Add a child component. More... | |
void | AddChild (void *child) |
Add a child component. More... | |
void | SetName (const wpi::Twine &moduleType, int channel) |
Sets the name of the sensor with a channel number. More... | |
void | SetName (const wpi::Twine &moduleType, int moduleNumber, int channel) |
Sets the name of the sensor with a module and channel number. More... | |
![]() | |
double | m_deadband = 0.02 |
double | m_maxOutput = 1.0 |
MotorSafetyHelper | m_safetyHelper {this} |
A class for driving Mecanum drive platforms.
Mecanum drives are rectangular with one wheel on each corner. Each wheel has rollers toed in 45 degrees toward the front or back. When looking at the wheels from the top, the roller axles should form an X across the robot.
Drive base diagram:
\_______/ \ | | / | | /_|___|_\ / \
Each Drive() function provides different inverse kinematic relations for a Mecanum drive robot. Motor outputs for the right side are negated, so motor direction inversion by the user is usually unnecessary.
This library uses the NED axes convention (North-East-Down as external reference in the world frame): http://www.nuclearprojects.com/ins/images/axis_big.png.
The positive X axis points ahead, the positive Y axis points to the right, and the positive Z axis points down. Rotations follow the right-hand rule, so clockwise rotation around the Z axis is positive.
Inputs smaller then 0.02 will be set to 0, and larger values will be scaled so that the full range is still used. This deadband value can be changed with SetDeadband().
RobotDrive porting guide:
In MecanumDrive, the right side speed controllers are automatically inverted, while in RobotDrive, no speed controllers are automatically inverted.
DriveCartesian(double, double, double, double) is equivalent to RobotDrive::MecanumDrive_Cartesian(double, double, double, double) if a deadband of 0 is used, and the ySpeed and gyroAngle values are inverted compared to RobotDrive (eg DriveCartesian(xSpeed, -ySpeed, zRotation, -gyroAngle).
DrivePolar(double, double, double) is equivalent to RobotDrive::MecanumDrive_Polar(double, double, double) if a deadband of 0 is used.
frc::MecanumDrive::MecanumDrive | ( | SpeedController & | frontLeftMotor, |
SpeedController & | rearLeftMotor, | ||
SpeedController & | frontRightMotor, | ||
SpeedController & | rearRightMotor | ||
) |
Construct a MecanumDrive.
If a motor needs to be inverted, do so before passing it in.
void frc::MecanumDrive::DriveCartesian | ( | double | ySpeed, |
double | xSpeed, | ||
double | zRotation, | ||
double | gyroAngle = 0.0 |
||
) |
Drive method for Mecanum platform.
Angles are measured clockwise from the positive X axis. The robot's speed is independent from its angle or rotation rate.
ySpeed | The robot's speed along the Y axis [-1.0..1.0]. Right is positive. |
xSpeed | The robot's speed along the X axis [-1.0..1.0]. Forward is positive. |
zRotation | The robot's rotation rate around the Z axis [-1.0..1.0]. Clockwise is positive. |
gyroAngle | The current angle reading from the gyro in degrees around the Z axis. Use this to implement field-oriented controls. |
void frc::MecanumDrive::DrivePolar | ( | double | magnitude, |
double | angle, | ||
double | zRotation | ||
) |
Drive method for Mecanum platform.
Angles are measured clockwise from the positive X axis. The robot's speed is independent from its angle or rotation rate.
magnitude | The robot's speed at a given angle [-1.0..1.0]. Forward is positive. |
angle | The angle around the Z axis at which the robot drives in degrees [-180..180]. |
zRotation | The robot's rotation rate around the Z axis [-1.0..1.0]. Clockwise is positive. |
|
overridevirtual |
bool frc::MecanumDrive::IsRightSideInverted | ( | ) | const |
Gets if the power sent to the right side of the drivetrain is multipled by -1.
void frc::MecanumDrive::SetRightSideInverted | ( | bool | rightSideInverted | ) |
Sets if the power sent to the right side of the drivetrain should be multipled by -1.
rightSideInverted | true if right side power should be multipled by -1 |