add yaw for control, see https://code.ros.org/trac/wg-ros-pkg/ticket/5118 for original ticket
Merge pull request #6 from k-okada/add_roll_pitch_yaw

add yaw for control