Add motor current checks when running frequency calibrations

Per Mitsuko, we need to make sure to check the motor currents after doing the frequency calibrations. >=0.3A for phi, >=0.5A for theta.