Method for constructing motion space for robot under inherent constraints

Abstract

The invention relates to a method for constructing a motion space for a robot under inherent constraints. The method is characterized in that the method includes: (Step S1) with supporting legs as an origin of coordinates, floating body kinematics is introduced into a body base coordinate system to create a joint chain and kinematic model based on the joints of the whole body; (Step S2) on the basis of the joint chain and kinematic model, a joint angle range constraint and a stability constraint are introduced, and the Monte Carlo method is utilized to sample and solve a working space for the end actuators of the robot, so that a three-dimensional point cloud grid formed by the working space is obtained; (Step S3) on the basis of the three-dimensional point cloud grid, plane cutting is carried out, and by means of extreme value analysis, the extreme value state and position and posture diagram of the robot in each direction are obtained. In comparison with the prior art, with the solution of the working space of the robot under the complex motion of the whole body as a goal, the method obtains the boundary range of the working space of end tracks under a complex condition meeting inherent constraints on the basis of the numerical algorithm.

Description

technical field [0001] The invention relates to the field of robot control, in particular to a method for constructing a robot motion space under inherent constraints. Background technique [0002] A common task of humanoid robots in daily use is to grasp objects with arms and hands, and a related issue is the range or space that the robot can encounter. In these tasks, whether the robot's operator can touch the target object is a question that must be answered. like figure 1 In the judgment process, if the object is within the reach of the hand, the robot can directly execute the grasping behavior to complete the task, otherwise, the robot needs to move or walk so that the reachable space of the robot arm contains the target object. [0003] The robot workspace is the Cartesian space that the end effector can reach under the constraints, which is the set of points that can be reached by a point on the robot end member. The size of the robot's working space represents the...

AI Technical Summary

Problems solved by technology

[0004] Generally, the positioning accuracy of robot grasping is not high, and repeated positioning is often required. One of the main factors affecting its positioning accuracy is that the existing methods are mainly based on traditional kinematics, and the body base is marked as constant static, so the calculated robot motion space Inaccurate and incomplete construction

Images