Added motor_control example plus fixes