move sonar to sensors.c add sonar_t