l1: change a max to min in wp switch-distance calculation

compare: https://github.com/diydrones/ardupilot/blob/master/libraries/AP_L1_Control/AP_L1_Control.cpp?source=cc#L73