k Cos
Create a new kCos on the setpoint.
Parameters
k Cos
the kCos gain
setpoint To Radians
conversion function to convert the supplied setpoint (usually in motor ticks) to radians, see EncoderTicks
Create a new kCos on the dynamic angular position of the system.
Parameters
k Cos
the kCos gain
angle
current angular state of the system, see EncoderTicks