BugFix( pos & yaw )

Fixed a bug that perspective of set home becomes abnormal.