Certified detection of parallel robot assembly mode under Type 2 singularity crossing trajectories

摘要

Increasing the size of operationnal workspace is one of the main problems parallel robots are faced with. Among all the proposed solutions to that, crossing Type 2 singularities using dedicated trajectory generation and multi-model controller has a great potential. Yet, this approach is not sufficient for the robot to operate autonomously, as assembly mode detection during the motion currently requires additional redundant information. To tackle this problem, we propose an algorithm based on Interval Analysis (IA) that is able to track the end-effector of the robot even under assembly mode change. IA-based solvers for the forward kinematic problem of parallel robots are well known, but they cannot be used under assembly mode change. Compared to those classical approaches, the major modification introduced is the tracking of end-effector velocity in addition to its pose. Using this new information of velocity, the algorithm is capable to monitor the assembly mode change of the robot happening when the singularities are crossed. The behavior and the reliability of this algorithm are analyzed experimentally on a five-bar planar parallel mechanism.