Generation of Configuration Space Trajectories Over Semi-Constrained Cartesian Paths for Robotic Manipulators

Serial-link manipulators are required to execute trajectories that enable a robot end-effector or a tool to track a Cartesian path. Practical applications may not require constraining all six degrees of freedom (position and orientation) of the tool resulting in semi-constrained paths. Semi-constrained paths allow improved success rates and better quality trajectories as the robot has more freedom to meet the kinematic and dynamic constraints. Additionally, robotic applications will need to use multiple tool center points (TCPs) on the tool to generate feasible paths for the robot. We present an iterative graph construction method to find trajectories for semi-constrained Cartesian paths that also use multiple TCPs. Our graph-based method finds multiple inverse kinematic solutions for possible Cartesian poses that the robot can take and connects them to build a graph. The algorithm uses cues from the Cartesian space to prioritize poses that produce a better quality solution. A biasing scheme is also developed to selectively sample the starting Cartesian poses from available choices. Our method finds near-optimal solutions with significantly fewer nodes and edges in the graph. The algorithm's performance results on complex industrial test cases are provided. Note to Practitioners—Industrial applications permit the relaxation of one or more degrees of freedom of the tool while following the Cartesian paths. The relaxation of constraints is introduced by defining tolerances between the tool and the workpiece. Multiple TCPs have to be employed for many tasks to use different surfaces of the tool. In this paper, we present a planning algorithm for semi-constrained Cartesian paths that can incorporate the use of multiple TCPs. The user can define discrete TCPs over the tool contact points or surfaces. The tolerances can be easily defined as angular limits on tool orientation along the Cartesian path. Our planning algorithm can work with others via point constraints in Cartesian space or joint space of the robot. Practitioners from the industry can use the method presented in this paper to develop automated robotic cells that do cutting, sanding, polishing, welding, painting, composite layup, additive manufacturing, and several other common applications.