A novel tool path smoothing algorithm of 6R manipulator considering pose-dependent dynamics by designing asymmetrical FIR filters

The joint dynamic constraints of robot manipulators are normally set to conservative constant values to meet the dynamic tolerances at different poses, which leads to incomplete utilization of the joint drive capability. To fully utilize the drive capability of joint drives, this paper proposes an asymmetrical finite impulse response (FIR) filter-based tool path smoothing algorithm, which considers the pose-dependent dynamics of the robot with 6 rotational (6R) joints. To analyze the pose-dependent motor drive capabilities, a simplified dynamics model is established by considering both the tangential and joint dynamic constraints. An asymmetrical FIR filter-based tool path smoothing algorithm is also proposed to realize different constraints of the acceleration and the deceleration limits at different positions of the linear segments. The tool tip position and the tool orientation commands are respectively smoothed in the Cartesian coordinate system and spherical coordinate system, with the constraints of the tool path deviations in the task frame. The synchronization of the position and the orientation is realized by adjusting the parameters of FIR filters. The simulation and experimental results show that the proposed algorithm guarantees the corner error tolerances of the tool tip position and the tool orientation. Moreover, the proposed method improves the robot motion efficiency by more than 10 % through the full utilization of the joint drive capability compared with the traditional tool path smoothing algorithm based on symmetrical FIR filters.