Motion track planning method for mechanical arm servo tumbling satellite butt joint circular ring

Abstract

The invention discloses a motion track planning method for a mechanical arm servo tumbling satellite docking ring, and relates to the field of track planning. The method aims at solving the problem that when an existing mechanical arm servo planning technology is applied to a failed satellite, a capture point of a docking ring of the failed satellite cannot be locked, and consequently the tail end track of a mechanical arm drifts on the docking ring in the tracking process. The method comprises the steps that a pose matrix eTb of a mechanical arm base system relative to a tail end tool system is obtained; obtaining a pose matrix eTg of the docking ring capture point coordinate system relative to the end tool system; the attitude information of a mechanical arm base system in the eTb is utilized, the tail end tool system serves as a reference coordinate system, the eTg is reconstructed, and the pose information [d, gamma] of the reconstructed docking ring capture point coordinate system relative to the tail end tool system is obtained; planning an expected path at the tail end of the mechanical arm based on a trigonometric function, so that [d, gamma] is converged to a capture tolerance within a preset time; and obtaining the subdivided joint track of the mechanical arm by using the expected path at the tail end of the mechanical arm. The method is used for planning the motion trail of the servo butt joint circular ring of the mechanical arm.

Description

technical field [0001] The invention relates to the field of trajectory planning, in particular to a motion trajectory planning method for a robot arm servo-tumbling satellite docking ring. Background technique [0002] The failed satellites have no cooperative markers. In order to capture such satellites, a hand-eye camera is installed at the end of the robotic arm, and the relative pose between the end tool system and the target is obtained by measuring typical features on the satellite. Common features of failed satellites include docking rings, sail brackets, antennas, etc. Among them, the docking ring has sufficient strength and can be used as the grasping interface of the end tool. Therefore, the docking ring is the most ideal servo target and capture interface for the failed satellite. In addition, the failure target is generally in the rolling state of rotation-coupled nutation. Capturing this type of target poses a huge challenge to the servo planning technology of...

AI Technical Summary

Problems solved by technology

[0004] The purpose of the present invention is to solve the problem that the trajectory of the end of the mechanical arm drifts on the docking ring during the tracking process due to the inability to lock the capture point of the docking ring of the failed satellite when the existing robotic arm servo planning technology is applied to the failed satellite. The completion of the servo within the specified time causes the target to drift out of the working space of the manipulator, and a motion trajectory planning method for the manipulator servo tumbling satellite docking ring is proposed

Images