some changes
Update for Play_motion_sm for new msg
Merge pull request #129 from reem-utils/chang_branch

Chang branch