An Algorithm for Generation of Coordinated Robot Trajectories in Cartesian Space
In the paper a trajectory generation algorithm for two robots’ coordinated motion is presented. Two instances of the algorithm, each for one robot, run in the same time and calculate trajectories’ position and orientation coordinates. Initial and end robots’ end-effectors poses are defined and values of linear and angular speeds are programmed. To minimize relative position and orientation errors an idea of corrective motion is introduced. Trajectory coordinates are calculated as the sum of programmed and corrective motion. The algorithm was implemented in a simulation environment and results of simulation are presented. Static accuracy analysis for general case and stability verification for fixed values of robots’ parameters are described. Finally, an outline of proposed procedure of building a virtual environment for reachability verification and collision checking is presented.