Combined the Vision and Mecanum code