improved lead/trailing averages for wall following by removing 0-length points