Test software for updated mecanum drive