stargate entry yaw math is almost correct