Control method of mechanical arm Constrain Space
A control method and technology of robotic arms, which are applied in manipulators, program-controlled manipulators, manufacturing tools, etc., can solve the problems of algorithm control accuracy and low flexibility, achieve good bio-simulation, improve flexibility, improve control accuracy and spirit effect
- Summary
- Abstract
- Description
- Claims
- Application Information
AI Technical Summary
Problems solved by technology
Method used
Image
Examples
Embodiment 1
[0045] The embodiment of the control method of the manipulator Constrain Space of the present invention is basically as attached figure 1 shown, including steps:
[0046] S1. Determine the working plane of the manipulator;
[0047] S2. In the working plane, determine the safe area for the rotation of the mechanical arm according to the position distribution information of the obstacles;
[0048] S3, setting the movement path of the mechanical arm in the safe area;
[0049] S4. Establish the spatial model of the arm and the spatial model of the mechanical arm, and obtain the mapping relationship between the arm and the mechanical arm;
[0050] S5. Obtain the three-dimensional coordinates of the arm joints, and calculate the corresponding three-dimensional coordinates of the mechanical arm joints according to the mapping relationship between the arm and the mechanical arm;
[0051] S6. Calculate the joint value of the mechanical arm from the three-dimensional coordinates of t...
Embodiment 2
[0070] The only difference from Example 1 is that after obtaining the three-dimensional coordinates of the arm joints, when calculating the corresponding three-dimensional coordinates of the manipulator joints according to the mapping relationship between the arm and the manipulator, in order to reduce the amount of subsequent calculations, the arm joints The three-dimensional coordinates and the three-dimensional coordinates of the manipulator joints are transformed into the same coordinate system, thereby avoiding unnecessary coordinate transformations.
Embodiment 3
[0072] The only difference from Embodiment 2 is that when the focus of the camera is suddenly blurred due to movement, or the area occupied by the dynamic object becomes smaller due to the change from near to far, a pre-judgment is made to determine whether the focus of the camera is suddenly blurred or the dynamic object is moving. Is the area occupied by the target smaller in the frame due to the movement of the lens or the movement of the object being photographed. Specifically, set the reference object in advance to determine whether there is relative motion between the camera or the captured object and the reference object: if there is relative motion between the camera and the reference object, it means that the focus of the camera is suddenly blurred or the dynamic target is in the frame. The smaller occupied area is caused by the movement of the lens. At this time, adjust the static posture of the camera to keep it still; on the contrary, if there is relative motion bet...
PUM
Login to View More Abstract
Description
Claims
Application Information
Login to View More 
