added distance calc to avoidobst and K3Supervisor