Copter: bug fix for conditional_distance command

Due to a race condition, the wp_distance was not being updated before
the conditional_distance