Finished version without RSAI motor driver - ready for testing