Issue148

change srv and fix generation script program
 - add error msg (string data) into ts_state_control.srv file

add error handling program in move function
 - create error handling
 - If TS catch an error from RP_subtask, smach state will transit "aborted" state.
 - test 6 error type