Finalized the DC Motor fixes in the firmware, API still needs work