check joint state and set movep for odom disable robot

for #199.