More docking fixes

- Fly away from destination will now turn if pointing right at the coordinates
- if max_cos is increased, min_d is decreased to allow course corrections to be carried out
- minimum approach to coordinates speed reduced for docking