Major refactoring on motors_interface