modify motion
modify R_STATE
Robot Motion change
add make file