Changed arduino code to support 6 motors