A control system for controlling the movements of a plurality of mechanical units. The control system includes a program that includes a plurality of mechanical unit programs. Each program includes movement instructions for at least one of the mechanical units. The control system also includes a plurality of path planners. At least one of the path planners is adapted to receive instructions from more than one of the mechanical unit programs and on basis thereof determine how the mechanical units should move in order to synchronize their movements. The control system further includes switches adapted to switch a mechanical unit program from one path planner to another, whereby the movements of the mechanical units are synchronized when their mechanical unit programs are connected to the same path planner and the movements of the mechanical units are independent when their mechanical unit programs are connected to different path planners.