Major overhaul. The motor instances are now combined to reduce the flash and ram usage. Also it now writes directly to the port registers to increase the speed