A novel 3D path following control framework for robots performing surface finishing tasks

We describe a novel 3D path following control framework for articulated robots in applications where constant speed travel along a path is desirable, such as robotic surface finishing tasks. Given the desired robot configuration sequence with a list of waypoints along a path, a trajectory optimization scheme based on direct collocation is proposed to determine the Cartesian path and the maximum constant translation speed that are dynamically feasible. Employing the Hermite–Simpson collocation method, a Cartesian path is developed that not only preserves the characteristics of the original motion sequence but also satisfies the physical requirements of the robot kinematics and dynamics. Since joint velocity control is quite common in many industrial robots, we consider a 3D kinematic control in the robot tool frame with control inputs as rate of change of orientation. The objective for the translation motion is to achieve constant speed along the path tangent direction, and that of the orientation control is to orient the robot properly based on the path provided by a converging path planner. We describe the optimization procedure employed with the direct collocation method to obtain the desired Cartesian path, an arc-length based re-parametrization of the desired path, and a path planner that provides a converging path to the desired path. To perform the surface finishing operation, we further present the joint space control law that is converted from the synthesis of the proposed path following and impedance force control in the tool frame. To verify and evaluate the performance of the proposed framework, we have conducted extensive experiments with a six degrees-of-freedom (DOF) industrial robot for several paths that can be employed for surface finishing of a variety of industrial parts.