private void setOrientation()
{
orientation.Up = normal;
orientation.Right = Vector3.Cross(orientation.Up, heading);
orientation.Right = Vector3.Normalize(orientation.Right);
orientation.Forward = Vector3.Cross(-orientation.Right, orientation.Up);
orientation.Forward = Vector3.Normalize(orientation.Forward);
}