calculate
Deprecated
Use feedforward instead
Calculate the heading PID for the robot.
Return
The calculated output of the PID controller.
Parameters
measurement
The current heading of the robot.
setpoint
The desired heading of the robot.