This does not belong into the motor driver, its part of the FMU driver.