revise-> get_all_contact() add radian value for position of hexapod ->unitialize() improve for radian input and output -> get_all_pose() , goto_wait()
revise-> get_all_contact() add radian value for position of hexapod ->unitialize() improve for radian input and output -> get_all_pose() , goto_wait()