tested ultrasonic_sensor.cpp and motor.cpp