Move initial direction calculation to navigation code

This is needed to handle off mesh connections sanely.
Offset obstacle mins down by agent height