Added some tests about physical parameters.
Added arm_trajectory_is_finished.