modify end determination of move function

 - move end determination: dis_error:5mm, ang_error:2deg
 - modify TS generate script program