Motorcontrol_tb gefixed