MOTOR_CONTROL: Rework plugin for the lastest motor control driver