CN112894752A - Position searching method of mobile processing robot - Google Patents

Position searching method of mobile processing robot Download PDF

Info

Publication number
CN112894752A
CN112894752A CN202110073814.8A CN202110073814A CN112894752A CN 112894752 A CN112894752 A CN 112894752A CN 202110073814 A CN202110073814 A CN 202110073814A CN 112894752 A CN112894752 A CN 112894752A
Authority
CN
China
Prior art keywords
robot
mechanical arm
base
mobile
mobile processing
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110073814.8A
Other languages
Chinese (zh)
Other versions
CN112894752B (en
Inventor
陶波
韩世博
赵兴炜
丁汉
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Huazhong University of Science and Technology
Original Assignee
Huazhong University of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Huazhong University of Science and Technology filed Critical Huazhong University of Science and Technology
Priority to CN202110073814.8A priority Critical patent/CN112894752B/en
Publication of CN112894752A publication Critical patent/CN112894752A/en
Application granted granted Critical
Publication of CN112894752B publication Critical patent/CN112894752B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00—Manipulators mounted on wheels or on carriages
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J18/00—Arms
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1661—Programme controls characterised by programming, planning systems for manipulators characterised by task planning, object-oriented languages

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

The invention discloses a position searching method of a mobile processing robot, belonging to the field of robot control, and the method comprises the following steps: s1: calibrating the vehicle arm to obtain a base F of the mobile processing robotROBOTAnd a rigid body F fixedly connected on the movable chassisAGVmarkThe conversion relationship between them; s2: adjusting the position of the mobile processing robot, recording FAGVmarkAnd a movable chassis FAGVObtaining the coordinates of FAGVmarkAnd FAGVThe conversion relationship between them; s3: acquiring the moving chassis F in the moving process of the mobile processing robotAGVBased on the transformation relationship, calculating the robot base FROBOTTo position the robot base. The method has the advantages of simple operation in the calibration process, quick algorithm reaction and high positioning accuracy, and improves the machineFlexibility of human movement processing.

Description

Position searching method of mobile processing robot
Technical Field
The invention belongs to the field of robot control, and particularly relates to a position searching method of a mobile processing robot.
Background
The mobile processing robot expands the operation range of the fixed robot, is more flexible in configuration, has incomparable advantages in a large-range working space, and has very important value in the processing of large-scale equipment and the operation of large-scale equipment. In production, obtaining the position of the base of the mechanical arm is an important step, is the basis of robot operation, and has important influence on the programming complexity and the actual use effect of the mechanical arm.
The existing robot positioning device usually needs to be provided with a special calibration device, has strict requirements on the motion of the robot in the calibration process, and has lower calibration efficiency. In addition, the position of the robot base cannot be determined, and sufficient positioning information cannot be provided for robot control operation.
Disclosure of Invention
Aiming at the defects or the improvement requirements of the prior art, the invention provides a position finding method of a mobile processing robot, aiming at improving the flexibility of the calibration of a mechanical arm, accurately and efficiently determining the position of a robot base, and conveniently providing sufficient positioning information for the control operation of the robot, thereby solving the technical problems of low calibration efficiency and positioning efficiency in the prior art.
To achieve the above object, according to an aspect of the present invention, there is provided a locating method of a mobile processing robot, including:
s1: calibrating the vehicle arm to obtain a base F of the mobile processing robotROBOTAnd a rigid body F fixedly connected on the movable chassisAGVmarkThe conversion relationship between them;
s2: adjusting the position of the mobile processing robot, recording FAGVmarkAnd a movable chassis FAGVObtaining the coordinates of FAGVmarkAnd FAGVThe conversion relationship between them;
s3: acquiring the moving chassis F in the moving process of the mobile processing robotAGVBased on the transformation relationship, calculating the robot base FROBOTTo position the robot base.
In one embodiment, the step S1 includes:
s101: initializing a calibration environment, fixingThe base of the mechanical arm is in a state when the mechanical arm is reset, and the initial position P of the tail end of the mobile processing robot in a base coordinate system corresponding to the mechanical arm is recorded1Simultaneously recording the initial coordinates T of the rigid bodyAGVmark；
S102: fixing a target ball at the Kth joint of the mechanical arm and keeping away from the axis of the Kth joint as far as possible, wherein K is more than or equal to K0Kth of mechanical arm0Rotation direction of joint and 1 st to Kth joints0-1 the rotational directions of the joints are all different;
s103: calibrating a first axial direction, enabling the mechanical arm to be in a state when the system is reset, rotating a first joint of the mechanical arm, and recording the position of a first target ball;
s104: calibrating the second axial direction, enabling the mechanical arm to be in a state when the system is reset, rotating the Nth joint of the mechanical arm, and recording the position of a second target ball;
s105: calibrating an original point, enabling the mechanical arm to be in a state when the system is reset, rotating the Kth joint by 180 degrees, and recording the position P of the tail end of the mobile processing robot in a mechanical arm base coordinate system2(ii) a Selecting a joint of the mechanical arm in a first joint or an N-th joint, wherein the rotation direction of the joint is different from that of a K-th shaft, rotating, and recording the position of a third target ball;
s106: determining axial Axis1, Axis2, Axis3, and normal vector r of the coordinate system of the pedestal using the first, second, and third target ball positions1、r2、r3And center O of circle1、O2、O3；
S107: using formulas
Figure BDA0002906868180000021
Calculating the origin P of the coordinate system of the base0；
S108: obtaining a coordinate system of the base
Figure BDA0002906868180000031
R is a matrix obtained by arranging Axis1, Axis2 and Axis3 according to the modes of an x Axis, a y Axis and a z Axis;
s109: obtaining a Mobile machining robot base FROBOTAnd a rigid body F fixedly connected on the movable chassisAGVmarkThe conversion relationship between the two is as follows:
Figure BDA0002906868180000032
in one embodiment, the center O of the circle is calculated in S1061、O2、O3The process of (2) is as follows:
marking the position of the first target ball as Xa Ya Za]，Xa＝[Xa1,Xa2,…,Xai]、Ya＝[Ya1,Ya2,…,Yai]、Za＝[Za1,Za2,…,Zai]I is not less than 4; the second target ball position is [ X ]b Yb Zb]，Xb＝[Xb1,Xb2,…,Xbi]、Yb＝[Yb1,Yb2,…,Ybi]、Zb＝[Zb1,Zb2,…,Zbi](ii) a The third target ball position is [ X ]c Yc Zc]，Xc＝[Xc1,Xc2,…,Xci]、Yc＝[Yc1,Yc2,…,Yci]、Zc＝[Zc1,Zc2,…,Zci](ii) a Note additionally As＝[-2Xa -2Xb -2Xc 1]；
Figure BDA0002906868180000033
Figure BDA0002906868180000034
Figure BDA0002906868180000035
Then
Circle center coordinate
Figure BDA0002906868180000036
Figure BDA0002906868180000037
Is CiraItem i of (1);
circle center coordinate
Figure BDA0002906868180000038
Figure BDA0002906868180000039
Is CirbItem i of (1);
circle center coordinate
Figure BDA00029068681800000310
Figure BDA00029068681800000311
Is CircItem i of (1).
In one embodiment, the robot base coordinate system axial Axis1, Axis2, Axis3 and normal vector r are calculated in S1061、r2、r3The process of (2) is as follows:
for normal vector r1Record As＝[Xa2-Xa1，Xa3-Xa1，…，Xai-Xa1]、Bs＝[Ya2-Ya1，Ya3-Ya1，…，Yai-Ya1]、Cs＝[Za2-Za1，Za3-Za1，…，Zai-Za1]、Tan＝[As Bs]Then the normal vector r1＝[(TanT Tan)-1 TanT CS-1](ii) a For normal vector r2Will calculate a normal vector r1The subscript of the formula is replaced by b from a to obtain a normal vector r2The calculation formula of (2); for normal vector r3Will calculate a normal vector r1The subscript of the formula is replaced by c from a to obtain a normal vector r3The calculation formula of (2);
using the formula Axis1 ═ r1；Axis2＝±r2(ii) a Axis3 ±. Axis1 × ±. Axis2 calculates the axial Axis1, Axis2, Axis3 of the coordinate system of the base.
In one embodiment, the step S2 includes:
s201: keeping the system configuration parameters in the calibration of the vehicle arm unchanged and carrying out positioning setting;
s202: adjusting the position of the mobile processing robot, and recording the coordinate X of the mobile chassis corresponding to each positioni＝[xi yi θi]And the coordinates of the rigid body
Figure BDA0002906868180000041
Repeatedly moving the mobile robot and recording corresponding groups of XiAnd Yi；
S203: based on multiple groups of XiAnd YiAnd acquiring a mapping relation between the coordinates of the mobile chassis and the coordinates of the rigid body.
In one embodiment, the step S203 includes:
taking the intermediate variable Tvec,i＝vec([Ri Pi])，Pvec,i＝[xi yi sin(θi) cos(θi) 1]；
Note the book
Figure BDA0002906868180000042
The mapping relationship between the coordinates of the mobile chassis and the coordinates of the rigid body is
Figure BDA0002906868180000043
In one embodiment, the step S3 includes:
obtaining a mobile chassis coordinate P during the movement of the mobile machining roboti＝[x y θ]Based on the conversion relation T and the mapping relation TdimAnd calculating to obtain the coordinates of the robot base as follows: t isrobot＝Tdim·[x y sinθ cosθ 1]T。
In general, compared with the prior art, the above technical solution contemplated by the present invention can achieve the following beneficial effects:
1. the conversion relation between the coordinate system of the base and the coordinates of a fixed connection rigid body on a mobile chassis is obtained by calibrating the arm of the mobile processing robot; further, moving the calibration object to a corresponding preset position for multiple times, and recording the coordinates of the mobile chassis and the coordinates of the rigid body to obtain the mapping relation between the coordinates of the mobile chassis and the coordinates of the rigid body; and finally, calculating the coordinates of the base based on the conversion relation and the mapping relation when the coordinates of the mobile chassis are known. The mobile processing robot positioning method is simple to operate, quick in response and high in accuracy. The method can obtain the position of the base of the mobile processing robot through a commonly used two-dimensional positioning system of the mobile chassis, is suitable for various processing and operation scenes, and improves the flexibility of the mobile processing of the robot.
2. In the calibration process, a first axial direction is calibrated and a first target ball position is recorded, a second axial direction is calibrated and a second target ball position is recorded, a third calibration position is calculated by a calibration origin, and the axial directions Axis1, Axis2, Axis3 and a normal vector r of the coordinate system of the base are determined by using the first target ball position, the second target ball position and the third target ball position1、r2、r3And center O of circle1、O2、O3The calibration process is simple, the calibration efficiency is high, and meanwhile, the flexibility of mechanical arm calibration can be improved.
Drawings
FIG. 1 is a schematic diagram of an environmental application of a locating method of a mobile processing robot according to an embodiment of the present invention;
FIG. 2 is a flow chart illustrating a method for locating a mobile processing robot in accordance with an embodiment of the present invention;
FIG. 3 is a flowchart of step S2 according to an embodiment of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention. In addition, the technical features involved in the embodiments of the present invention described below may be combined with each other as long as they do not conflict with each other.
To achieve the above object, according to one aspect of the present invention, there is provided a locating method of a mobile processing robot applied to an environment shown in fig. 1, wherein 1 is a robot arm, and 2 is a mobile chassis. The specific implementation process of the method is shown in fig. 2, and comprises the following steps: s1: calibrating the vehicle arm to obtain a base F of the mobile processing robotROBOTAnd a rigid body F fixedly connected on the movable chassisAGVmarkThe conversion relationship between them; s2: adjusting the position of the mobile processing robot, recording FAGVmarkAnd a movable chassis FAGVObtaining the coordinates of FAGVmarkAnd FAGVThe conversion relationship between them; s3: acquiring the moving chassis F in the moving process of the mobile processing robotAGVBased on the transformation relationship, calculating the robot base FROBOTTo position the robot base.
In one embodiment, step S1 includes:
s101: initializing a calibration environment, fixing a base of the mechanical arm, enabling the mechanical arm to be in a state when the system is reset, and recording an initial position P of the tail end of the mobile processing robot in a base coordinate system corresponding to the mechanical arm1Simultaneously recording the initial coordinates T of the rigid bodyAGVmark；
S102: fixing a target ball at the Kth joint of the mechanical arm and keeping the target ball away from the axis of the Kth joint as far as possible; specifically, a target ball is fixed in the calibration of the vehicle arm, and K is more than or equal to K0Kth of mechanical arm0Rotation direction of joint and 1 st to Kth joints0-1 the rotational directions of the joints are all different;
s103: calibrating a first axial direction, enabling the mechanical arm to be in a state when the system is reset, rotating a first joint of the mechanical arm, and recording the position of a first target ball; specifically, the first axis is calibrated in the calibration of the vehicle arm, the positions of the recorded target balls are not less than 4, and the positions are not too close to each other as far as possible. Recording the position of the target ballIs [ X ]a Ya Za]，Xa＝[Xa1,Xa2,…,Xai]、Ya＝[Ya1,Ya2,…,Yai]、Za＝[Za1,Za2,…,Zai]，i≥4；
S104: calibrating the second axial direction, enabling the mechanical arm to be in a state when the system is reset, rotating the Nth joint of the mechanical arm, and recording the position of a second target ball; specifically, a second axial direction is calibrated in the calibration of the vehicle arm, N is not less than 2 and not more than K-1, and the rotating direction of the second axial direction is not parallel to the rotating shaft of the first joint; the number of recorded target ball positions should not be less than 4 and should not be too close to each other as much as possible. The obtained target ball position is recorded as [ X ]b Yb Zb]，Xb＝[Xb1,Xb2,…,Xbi]、Yb＝[Yb1,Yb2,…,Ybi]、Zb＝[Zb1,Zb2,…,Zbi]。
S105: calibrating the original point, enabling the mechanical arm to be in a state when the system is reset, rotating the Kth joint by 180 degrees, and recording the position P of the tail end of the mobile processing robot in a mechanical arm base coordinate system2(ii) a Selecting a joint of the mechanical arm in a first joint or an N-th joint, wherein the rotation direction of the joint is different from that of a K-th shaft, rotating, and recording the position of a third target ball; specifically, the origin is calibrated in the calibration of the vehicle arm, the positions of the recorded target balls are not less than 4, and the distance between the recorded target balls is not too close to each other as much as possible. The obtained target ball position is recorded as Xc＝[Xc1,Xc2,…,Xci]、Yc＝[Yc1,Yc2,…,Yci]、Zc＝[Zc1,Zc2,…,Zci]。
S106: determining axial Axis1, Axis2, Axis3, and normal vector r of the coordinate system of the pedestal using the first target ball position, the second target ball position, and the third target ball position1、r2、r3And center O of circle1、O2、O3；
S107: using formulas
Figure BDA0002906868180000071
Calculating the origin P of the base coordinate system0Wherein O is1、O2Respectively refers to the circle centers r corresponding to the first target ball position and the second target ball position3Refers to the normal vector, P, corresponding to the third target ball position1And P2The positions of the fingers are as above, and are not described in detail herein;
s108: obtaining a coordinate system of the base
Figure BDA0002906868180000072
R is a matrix obtained by arranging Axis1, Axis2 and Axis3 according to the modes of an x Axis, a y Axis and a z Axis;
s109: obtaining a Mobile machining robot base FROBOTAnd a rigid body F fixedly connected on the movable chassisAGVmarkThe conversion relationship between the two is as follows:
Figure BDA0002906868180000073
according to the invention, the arm calibration and the dimension conversion calibration are only required to be executed when the system is built, and the arm calibration and the dimension conversion calibration are required to be carried out again only when the structure of the mobile processing robot is changed or the configuration of the mobile chassis positioning system is changed.
In one embodiment, center O is calculated in S1061、O2、O3The process of (2) is as follows:
marking the position of the first target ball as Xa Ya Za]，Xa＝[Xa1,Xa2,…,Xai]、Ya＝[Ya1,Ya2,…,Yai]、Za＝[Za1,Za2,…,Zai]I is not less than 4; the second target ball position is [ X ]b Yb Zb]，Xb＝[Xb1,Xb2,…,Xbi]、Yb＝[Yb1,Yb2,…,Ybi]、Zb＝[Zb1,Zb2,…,Zbi](ii) a The third target ball position is [ X ]c Yc Zc]，Xc＝[Xc1,Xc2,…,Xci]、Yc＝[Yc1,Yc2,…,Yci]、Zc＝[Zc1,Zc2,…,Zci](ii) a Note additionally As＝[-2Xa -2Xb -2Xc 1]；
Figure BDA0002906868180000081
Wherein symbol denotes the dot product of the vectors;
Figure BDA0002906868180000082
Figure BDA0002906868180000083
then
Circle center coordinate
Figure BDA0002906868180000084
Figure BDA0002906868180000085
Is CiraItem i of (1);
circle center coordinate
Figure BDA0002906868180000086
Figure BDA0002906868180000087
Is CirbItem i of (1);
circle center coordinate
Figure BDA0002906868180000088
Figure BDA0002906868180000089
Is CircItem i of (1).
In one embodiment, the robot base coordinate system axial Axis1, Axis2, Axis3 and normal vector r are calculated in S1061、r2、r3The process of (2) is as follows:
for normal vector r1Record As＝[Xa2-Xa1，Xa3-Xa1，…，Xai-Xa1]、Bs＝[Ya2-Ya1，Ya3-Ya1，…，Yai-Ya1]、Cs＝[Za2-Za1，Za3-Za1，…，Zai-Za1]、Tan＝[As Bs]Then the normal vector r1＝[(TanT Tan)-1 TanT CS-1](ii) a For normal vector r2Will calculate a normal vector r1The subscript of the formula is replaced by b from a to obtain a normal vector r2The calculation formula of (2); for normal vector r3Will calculate a normal vector r1The subscript of the formula is replaced by c from a to obtain a normal vector r3The calculation formula of (2);
using the formula Axis1 ═ r1；Axis2＝±r2(ii) a Axis3 ±. Axis1 × ±. Axis2 calculates the axial Axis1, Axis2, Axis3 of the coordinate system of the base, wherein the sign can be determined by the user on demand.
In one embodiment, as shown in fig. 2, step S2 includes:
s201: keeping the system configuration parameters in the calibration of the vehicle arm unchanged and carrying out positioning setting; specifically, the configuration of a positioning system in the vehicle arm calibration method is kept unchanged, and a mobile chassis positioning system is arranged and kept unchanged in later use.
S202: adjusting the position of the mobile processing robot, and recording the coordinate X of the mobile chassis corresponding to each preset positioni＝[xi yi θi]And coordinates of rigid body
Figure BDA0002906868180000091
Repeatedly moving the mobile processing robot and recording corresponding multiple groups of XiAnd Yi. In one embodiment, the number of sets is k, and k ≧ 24.
S203: and acquiring a mapping relation between the coordinates of the mobile chassis and the coordinates of the rigid body.
In one embodiment, step S203 includes:
taking the intermediate variable Tvec,i＝vec([Ri Pi])、Pvec,i＝[xi yi sin(θi) cos(θi) 1]；
Note the book
Figure BDA0002906868180000092
The mapping relationship between the coordinates of the mobile chassis and the coordinates of the rigid body is
Figure BDA0002906868180000093
In one embodiment, step S3 includes:
obtaining a mobile chassis coordinate P during the movement of the mobile processing roboti＝[x y θ]Based on the transformation relation T and the mapping relation TdimAnd calculating to obtain the coordinates of the robot base as follows: t isrobot＝Tdim·[x y sinθ cosθ 1]T。
It will be understood by those skilled in the art that the foregoing is only a preferred embodiment of the present invention, and is not intended to limit the invention, and that any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the scope of the present invention.

Claims (7)

1. A method for locating a mobile processing robot, comprising:
s1: calibrating the vehicle arm to obtain a base F of the mobile processing robotROBOTAnd a rigid body F fixedly connected on the movable chassisAGVmarkThe conversion relationship between them;
s2: adjusting the position of the mobile processing robot, recording FAGVmarkAnd a movable chassis FAGVObtaining the coordinates of FAGVmarkAnd FAGVThe conversion relationship between them;
s3: acquiring the moving chassis F in the moving process of the mobile processing robotAGVBased on the transformation relationship, calculating the robot baseFROBOTTo position the robot base.
2. A method for locating a mobile processing robot as claimed in claim 1, wherein said step S1 includes:
s101: initializing a calibration environment, fixing a base of the mechanical arm, enabling the mechanical arm to be in a state when the system is reset, and recording an initial position P of the tail end of the mobile processing robot in a base coordinate system corresponding to the mechanical arm1Fixing a series of target spheres on a movable chassis to form a rigid body which can be observed, and simultaneously recording the initial coordinate T of the rigid bodyAGVmark；
S102: fixing a target ball at the Kth joint of the mechanical arm and keeping away from the axis of the Kth joint as far as possible, wherein K is more than or equal to K0Kth of mechanical arm0Rotation direction of joint and 1 st to Kth joints0-1 the rotational directions of the joints are all different;
s103: calibrating a first axial direction, enabling the mechanical arm to be in a state when the system is reset, rotating a first joint of the mechanical arm, and recording the position of a first target ball;
s104: calibrating a second axial direction to enable the mechanical arm to be in a state when the system is reset, rotating the Nth joint of the mechanical arm, recording the position of a second target ball, wherein K-1 is more than or equal to N is more than or equal to 2, and the rotating direction of the second target ball is not parallel to the rotating shaft of the first joint;
s105: calibrating an original point, enabling the mechanical arm to be in a state when the system is reset, rotating the Kth joint by 180 degrees, and recording the position P of the tail end of the mobile processing robot in a mechanical arm base coordinate system2(ii) a Selecting a joint of the mechanical arm in a first joint or an N-th joint, wherein the rotation direction of the joint is different from that of a K-th shaft, rotating, and recording the position of a third target ball;
s106: determining axial Axis1, Axis2, Axis3, and normal vector r of the coordinate system of the pedestal using the first, second, and third target ball positions1、r2、r3And center O of circle1、O2、O3；
S107: using formulas
Figure FDA0002906868170000021
Calculating the origin P of the coordinate system of the base0；
S108: obtaining a coordinate system of the base
Figure FDA0002906868170000022
R is a matrix obtained by arranging Axis1, Axis2 and Axis3 according to the modes of an x Axis, a y Axis and a z Axis;
s109: obtaining a Mobile machining robot base FROBOTAnd a rigid body F fixedly connected on the movable chassisAGVmarkThe conversion relationship between the two is as follows:
Figure FDA0002906868170000023
3. a method for locating a mobile processing robot as claimed in claim 2, wherein the center O of the circle is calculated in S1061、O2、O3The process of (2) is as follows:
marking the position of the first target ball as Xa Ya Za]，Xa＝[Xa1,Xa2,…,Xai]、Ya＝[Ya1,Ya2,…,Yai]、Za＝[Za1,Za2,…,Zai]I is not less than 4; the second target ball position is [ X ]b Yb Zb]，Xb＝[Xb1,Xb2,…,Xbi]、Yb＝[Yb1,Yb2,…,Ybi]、Zb＝[Zb1,Zb2,…,Zbi](ii) a The third target ball position is [ X ]c Yc Zc]，Xc＝[Xc1,Xc2,…,Xci]、Yc＝[Yc1,Yc2,…,Yci]、Zc＝[Zc1,Zc2,…,Zci](ii) a Note additionally As＝[-2Xa -2Xb -2Xc 1]；
Figure FDA0002906868170000024
Figure FDA0002906868170000025
Figure FDA0002906868170000026
Then
Circle center coordinate
Figure FDA0002906868170000031
Figure FDA0002906868170000032
Is CiraItem i of (1);
circle center coordinate
Figure FDA0002906868170000033
Figure FDA0002906868170000034
Is CirbItem i of (1);
circle center coordinate
Figure FDA0002906868170000035
Figure FDA0002906868170000036
Is CircItem i of (1).
4. A method according to claim 3, wherein the robot base coordinate system axial direction Axis1, Axis2, Axis3 and normal vector r are calculated in S1061、r2、r3The process of (2) is as follows:
for normal vector r1Record As＝[Xa2-Xa1，Xa3-Xa1，…，Xai-Xa1]、Bs＝[Ya2-Ya1，Ya3-Ya1，…，Yai-Ya1]、Cs＝[Za2-Za1，Za3-Za1，…，Zai-Za1]、Tan＝[As Bs]Then the normal vector r1＝[(TanT Tan)-1 TanT CS -1](ii) a For normal vector r2Will calculate a normal vector r1The subscript of the formula is replaced by b from a to obtain a normal vector r2The calculation formula of (2); for normal vector r3Will calculate a normal vector r1The subscript of the formula is replaced by c from a to obtain a normal vector r3The calculation formula of (2);
using the formula Axis1 ═ r1；Axis2＝±r2(ii) a Axis3 ±. Axis1 × ±. Axis2 calculates the axial Axis1, Axis2, Axis3 of the coordinate system of the base.
5. A method for locating a mobile processing robot as claimed in claim 1, wherein said step S2 includes:
s201: keeping the system configuration parameters in the calibration of the vehicle arm unchanged and carrying out positioning setting;
s202: adjusting the position of the mobile processing robot, and recording the coordinate X of the mobile chassis corresponding to each positioni＝[xi yi θi]And the coordinates of the rigid body
Figure FDA0002906868170000037
Repeatedly moving the mobile robot and recording corresponding groups of XiAnd Yi；
S203: based on multiple groups of XiAnd YiAnd acquiring a mapping relation between the coordinates of the mobile chassis and the coordinates of the rigid body.
6. The method according to claim 5, wherein the step S203 comprises:
taking the intermediate variable Tvec,i＝vec([Ri Pi])，Pvec,i＝[xi yi sin(θi) cos(θi) 1]；
Note the book
Figure FDA0002906868170000041
The mapping relationship between the coordinates of the mobile chassis and the coordinates of the rigid body is
Figure FDA0002906868170000042
7. The method for locating a mobile processing robot according to any one of claims 1 to 6, wherein the step S3 includes:
obtaining a mobile chassis coordinate P during the movement of the mobile machining roboti＝[x y θ]Based on the conversion relation T and the mapping relation TdimAnd calculating to obtain the coordinates of the robot base as follows: t isrobot＝Tdim·[x y sinθ cosθ 1]T。
CN202110073814.8A 2021-01-20 2021-01-20 Position searching method of mobile processing robot Active CN112894752B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110073814.8A CN112894752B (en) 2021-01-20 2021-01-20 Position searching method of mobile processing robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110073814.8A CN112894752B (en) 2021-01-20 2021-01-20 Position searching method of mobile processing robot

Publications (2)

Publication Number Publication Date
CN112894752A true CN112894752A (en) 2021-06-04
CN112894752B CN112894752B (en) 2022-04-01

Family

ID=76116425

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110073814.8A Active CN112894752B (en) 2021-01-20 2021-01-20 Position searching method of mobile processing robot

Country Status (1)

Country Link
CN (1) CN112894752B (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113376649A (en) * 2021-06-30 2021-09-10 华中科技大学 Robot automatic local scanning planning method based on global rough scanning imaging
CN115383850A (en) * 2022-09-20 2022-11-25 上海寰宇物流科技有限公司 Improved oil point nailing equipment applied to floor

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109059922A (en) * 2018-06-29 2018-12-21 北京艾瑞思机器人技术有限公司 Method for positioning mobile robot, device and system
CN110640746A (en) * 2019-11-07 2020-01-03 上海电气集团股份有限公司 Method, system, equipment and medium for calibrating and positioning coordinate system of robot
CN110815205A (en) * 2018-08-14 2020-02-21 杭州海康机器人技术有限公司 Calibration method, system and device of mobile robot
CN110842918A (en) * 2019-10-24 2020-02-28 华中科技大学 Robot mobile processing autonomous locating method based on point cloud servo
CN111051012A (en) * 2016-07-15 2020-04-21 快砖知识产权私人有限公司 Robot arm kinematics for end effector control

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111051012A (en) * 2016-07-15 2020-04-21 快砖知识产权私人有限公司 Robot arm kinematics for end effector control
CN109059922A (en) * 2018-06-29 2018-12-21 北京艾瑞思机器人技术有限公司 Method for positioning mobile robot, device and system
CN110815205A (en) * 2018-08-14 2020-02-21 杭州海康机器人技术有限公司 Calibration method, system and device of mobile robot
CN110842918A (en) * 2019-10-24 2020-02-28 华中科技大学 Robot mobile processing autonomous locating method based on point cloud servo
CN110640746A (en) * 2019-11-07 2020-01-03 上海电气集团股份有限公司 Method, system, equipment and medium for calibrating and positioning coordinate system of robot

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113376649A (en) * 2021-06-30 2021-09-10 华中科技大学 Robot automatic local scanning planning method based on global rough scanning imaging
CN115383850A (en) * 2022-09-20 2022-11-25 上海寰宇物流科技有限公司 Improved oil point nailing equipment applied to floor

Also Published As

Publication number Publication date
CN112894752B (en) 2022-04-01

Similar Documents

Publication Publication Date Title
CN112894752B (en) Position searching method of mobile processing robot
CN108972559B (en) Hand-eye calibration method based on infrared stereoscopic vision positioning system and mechanical arm
CN107738254B (en) Conversion calibration method and system for mechanical arm coordinate system
CN106338990B (en) Industrial robot DH parameter calibration and Zero positioning method based on laser tracker
CN108324373B (en) Accurate positioning implementation method of puncture surgery robot based on electromagnetic positioning system
CN110695993B (en) Synchronous measurement method, system and device for flexible mechanical arm
CN110640747B (en) Hand-eye calibration method and system for robot, electronic equipment and storage medium
CN109227601A (en) Control device, robot, robot system and bearing calibration
CN107330926A (en) Non-marked medical figure registration system and method in a kind of art in navigation system
CN110919658B (en) Robot calibration method based on vision and multi-coordinate system closed-loop conversion
CN105823417B (en) A kind of method for turning station precision based on photogrammetric raising laser tracker
CN112067337B (en) Rapid hand-eye calibration device and calibration method based on standard ball binocular robot
CN109877840A (en) A kind of double mechanical arms scaling method based on camera optical axis constraint
CN107253191B (en) Double-mechanical-arm system and coordination control method thereof
CN113545851B (en) Control method, system, equipment and storage medium for reconstructing instrument surgical field center
CN114343847B (en) Hand-eye calibration method of surgical robot based on optical positioning system
CN109176487A (en) A kind of cooperating joint section scaling method, system, equipment, storage medium
CN111486867B (en) Calibration device and method for installation parameters of vision and inertia mixed tracking assembly
CN112792814A (en) Mechanical arm zero calibration method based on visual marks
CN113843792A (en) Hand-eye calibration method of surgical robot
CN113524201B (en) Active adjusting method and device for pose of mechanical arm, mechanical arm and readable storage medium
CN109282774B (en) Device and method for solving three-degree-of-freedom attitude of ball joint based on distance measurement
CN113814988B (en) 7-degree-of-freedom SRS type mechanical arm inverse solution analysis method and device and electronic equipment
CN113781558B (en) Robot vision locating method with decoupling gesture and position
CN110900608B (en) Robot kinematics calibration method based on optimal measurement configuration selection

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant