Fixed relative velocity error.
NLopt enabled