sasha's nav code with updated gyro