RAMSETE Controller

A nonlinear feedback controller for correcting robot position in the global coordinate system.
Prerequisites
A basic understanding of matrix multiplication
A basic understanding of trigonometry
​Odometry​
The RAMSETE controller is in a unique class of control algorithms, along with Pure Pursuit, that are designed to be used with the 2D motion of mobile robots. Typical controllers like PID operate in the local frame of the robot, controlling the robot's forward and backwards motion for example. The RAMSETE controller, on the other hand, controls the robot's global x, y, and heading position.
In order to control the robot's global position, we must first know the robot's current position and know the desired global position of the robot. We can find the robot's current position through Odometry. The desired global position for the robot can be a single (x, y, theta) point or a point along a computed path.
Computing Error
The first step with any control algorithm is determining the current error value. We can easily compute the robot's error in the global frame by subtracting the desired position from the current position.
[xdesired−xactualydesired−yactualθdesired−θactual]\begin{bmatrix} x_{desired} - x_{actual}\\ y_{desired} - y_{actual}\\ \theta_{desired} - \theta_{actual} \end{bmatrix}⎣⎡​xdesired​−xactual​ydesired​−yactual​θdesired​−θactual​​⎦⎤​
These error values don't give us much actionable data to control the robot though. For example, if the robot is facing the positive Y direction we can command the robot to drive forward to reduce the error in Y. However, if the robot is facing the positive X direction, commanding the robot to drive forward will reduce error in X this time and have no impact on the error in Y. We need to transform the error into a more useful form, the robot's local frame.
Applying the following transformation matrix to the global error vector gives us the robot's local error:
[exeyeθ]=[cos⁡θactualsin⁡θactual0−sin⁡θactualcos⁡θactual0001][xdesired−xactualydesired−yactualθdesired−θactual]\begin{equation*} \begin{bmatrix} e_x \\ e_y \\ e_\theta \end{bmatrix} = \begin{bmatrix} \cos\theta_{actual} & \sin\theta_{actual} & 0 \\ -\sin\theta_{actual} & \cos\theta_{actual} & 0 \\ 0 & 0 & 1 \end{bmatrix} \begin{bmatrix} x_{desired} - x_{actual} \\ y_{desired} - y_{actual} \\ \theta_{desired} - \theta_{actual} \end{bmatrix} \end{equation*}⎣⎡​ex​ey​eθ​​⎦⎤​=⎣⎡​cosθactual​−sinθactual​0​sinθactual​cosθactual​0​001​⎦⎤​⎣⎡​xdesired​−xactual​ydesired​−yactual​θdesired​−θactual​​⎦⎤​​
Where X in the local frame is the forward/backward direction of the robot's drivetrain.
Computing the Output Velocities
Now that we know the local error that the robot needs to correct for, we can calculate the angular and linear velocities to command the robot.
The first step is defining our controller's gain value. That gain comes from a few factors:
​bbb
: Roughly a proportional term for the controller. Large values of bbb
 will result in a more aggressive controller. Must be > 0.
​ζ\zetaζ
: Roughly a damping term (like the D term of a PID controller). Must be between 0 and 1.
​vdv_dvd​
: The desired linear velocity. This can come from a computed path or can be another tuning factor.
​ωd\omega_dωd​
: The desired angular velocity. This can come from a computed path or can be another tuning factor.
These factors combine with the following equation to give us a gain value kkk
 for the controller:
k=2∗ζ∗ωd2+b∗vd2k = 2 * \zeta * \sqrt{\omega_d^2 + b * v_d^2}k=2∗ζ∗ωd2​+b∗vd2​​
Tuning the Desired Velocities
Tuning the vdv_dvd​
 and ωd\omega_dωd​
 values is a bit tricky when they are not provided from a pre-computed path. If the controller is being used for correcting the robot's pose to a desired stopped position, for example, the desired velocity for the robot would be zero. However, setting these desired velocity values to zero will result in no output from the controller.
In a situation like this, it is recommended to set the desired velocity values to a small, non-zero value roughly scaled to the current error in the robot's local frame.
smallScalar=0.01vd=smallScalar∗exωd=smallScalar∗eθsmallScalar = 0.01\\ v_d = smallScalar * e_x\\ \omega_d = smallScalar * e_\thetasmallScalar=0.01vd​=smallScalar∗ex​ωd​=smallScalar∗eθ​
Do bear in mind, though, that the RAMSETE controller performs best when provided with a motion profile to follow rather than tuned, constant desired velocity values.
Outputs
The gain value is applied to the desired linear velocity (vdv_dvd​
), angular velocity (ωd\omega_dωd​
), and the local error (exe_xex​
, eye_yey​
, and eθe_\thetaeθ​
) to give us these velocity commands:
v=vd∗cos⁡eθ+k∗exω=ωd+k∗eθ+b∗vd∗sin⁡(eθ)∗eyeθv = v_d * \cos{e_\theta} + k * e_x\\ \omega = \omega_d + k * e_\theta + \frac{b * v_d * \sin(e_\theta) * e_y}{e_\theta}v=vd​∗coseθ​+k∗ex​ω=ωd​+k∗eθ​+eθ​b∗vd​∗sin(eθ​)∗ey​​
Commanding the Robot
The output of the RAMSETE controller is a linear velocity and an angular velocity. These values need to be transformed to command a typical tank-drive robot.
The linear velocity can be converted to the robot's left and right wheel velocities using the following equation:
linearMotorVelocity=vwheelCircumference\it{linearMotorVelocity} = \frac{v}{\it{wheelCircumference}}linearMotorVelocity=wheelCircumferencev​
The angular velocity can be converted to the robot's left and right wheel velocities using the following equation:
left=linearMotorVelocity+angularMotorVelocityright=linearMotorVelocity−angularMotorVelocity{\it{left} = \it{linearMotorVelocity} + \it{angularMotorVelocity}}\\right = {\it{linearMotorVelocity} - \it{angularMotorVelocity}}left=linearMotorVelocity+angularMotorVelocityright=linearMotorVelocity−angularMotorVelocity
Since the positive θ\thetaθ
 direction is turning the robot to the right, we'll apply the the angularMotorVelocity to get the following left and right wheel velocities
References:
​Controls Engineering in FRC​
​http://citeseerx.ist.psu.edu/viewdoc/download?doi=10.1.1.529.3557&rep=rep1&type=pdf​
Teams Contributed to this Article:
​BLRS (Purdue SIGBots)
Basic Pure Pursuit
Next - Software
Odometry
Last modified 10mo ago