1. Corrected the util documentaion; 2. Change the joint position PID control parameter