Method and system for determining a sequence of kinematic chains of a multiple robot

摘要

Systems and a method for determining a sequence of kinematic chains of a multiple robot along a sequence of locations. Inputs on the locations to be reached by a robot tool are received. Each chain is considered separately by setting one chain in use and determining, for each chain in use, available configurations for each location. The available configurations are represented as nodes of a graph representing available robotic paths for reaching with a tool the locations, while allowing the switching among different chains within the same robotic path. Valid connectors are determined by simulating collision free robot trajectories while taking into account working modality constraints of the locations. Weight factors are assigned to connectors to represent robot efforts in moving between subsequent configurations. The shortest robotic path among valid paths is determined by taking into account the weight factors. The sequence of chains is determined from the shortest path.