Basilisk:
Vizard:
Unit test for JointPIDController. Verifies that the controller computes the correct output for given input messages. Plots joint angle, velocity, and control torque if plot=True.