Wave Detection updates
Updating Wave detection, now it returns the degree (yaw) to rotate as well