Rewrote motor control logic, works now as intended.
Added launch file for minimal local operation.