Fixed math error in rendezvous autopilot match velocities step.

In some cases it would take the square root of a negative number and then try to create a maneuver node at UT = NaN, causing all sorts of problems.