CN111274696A - Method for acquiring spatial position and attitude of double triangular drill arms of drill jumbo in real time - Google Patents

Method for acquiring spatial position and attitude of double triangular drill arms of drill jumbo in real time Download PDF

Info

Publication number
CN111274696A
CN111274696A CN202010057135.7A CN202010057135A CN111274696A CN 111274696 A CN111274696 A CN 111274696A CN 202010057135 A CN202010057135 A CN 202010057135A CN 111274696 A CN111274696 A CN 111274696A
Authority
CN
China
Prior art keywords
coordinate system
joint
axis
point
establishing
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
CN202010057135.7A
Other languages
Chinese (zh)
Other versions
CN111274696B (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.)
Xuzhou XCMG Railway Equipment Co Ltd
Original Assignee
Xuzhou XCMG Railway Equipment Co Ltd
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 Xuzhou XCMG Railway Equipment Co Ltd filed Critical Xuzhou XCMG Railway Equipment Co Ltd
Priority to CN202010057135.7A priority Critical patent/CN111274696B/en
Publication of CN111274696A publication Critical patent/CN111274696A/en
Application granted granted Critical
Publication of CN111274696B publication Critical patent/CN111274696B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Drilling And Exploitation, And Mining Machines And Methods (AREA)
  • Earth Drilling (AREA)

Abstract

The invention discloses a method for acquiring the spatial position and posture of a double-triangular drill boom of a drill jumbo in real time. And (3) establishing a kinematic equation of the double-triangular drill boom according to the CFDH method, and comparing the simulation result of the virtual prototype with the kinematic equation to verify the correctness of the kinematic equation so as to obtain the accurate position posture of the double-triangular drill boom of the drill boom at any moment. The invention provides reliable guarantee for accurate drilling positioning of the double-triangular drill arm.

Description

Method for acquiring spatial position and attitude of double triangular drill arms of drill jumbo in real time
Technical Field
The invention relates to a positioning technology of a drill boom of a computer drill jumbo, in particular to a method for acquiring the spatial position posture of a double-triangular drill boom of the drill jumbo in real time.
Background
In the process of tunnel and mine exploitation, a full-hydraulic rock drilling trolley is generally used for drilling holes, and the accurate positioning of the drilling hole position is the key of the whole rock drilling hole construction. The positioning of the hole is realized by the movement of the drill arm controlled by the manipulator on the operation table. However, the working environment of the rock drilling machine is complex, dust and water vapor are more in the tunnel, and the driller is far away from the fracture surface, so that the hole positioning is inaccurate, the efficiency is low, and the deviation is large, thereby seriously affecting the blasting effect. In order to overcome the defect of manual positioning, the computer drilling trolley can acquire the three-dimensional space coordinate and the posture of the drill boom in real time, realize accurate auxiliary positioning and hole alignment, gradually replace the traditional full-hydraulic drilling trolley and quickly become mainstream mechanical equipment for tunnel construction. The double-triangular drill boom has the advantages of parallel movement in space, rapid action, compact structure and better stability, but is not easy to control, and the positioning precision is an important factor influencing the operation of the drill boom, so how to realize accurate control on the movement track of the drill boom has direct influence on whether the tail end of the drill boom and a fiber rod can be accurately positioned for drilling.
Disclosure of Invention
The invention aims to provide a method for acquiring the spatial position and the attitude of a double-triangular drill boom of a drill jumbo in real time, which can assist a drill rod to accurately align to a drilling position by accurately acquiring the spatial position and the attitude of the double-triangular drill boom.
In order to achieve the purpose, the method for acquiring the spatial position and the attitude of the front and rear double-triangular drill booms in real time comprises the steps of establishing a three-dimensional model of the double-triangular drill booms, then establishing a virtual prototype, and performing kinematic simulation on the double-triangular drill booms; establishing a kinematic equation of the double-triangular drill boom according to a CDFH method, and comparing a simulation result of a virtual prototype with the kinematic equation to verify the correctness of the kinematic equation so as to obtain the accurate position posture of the double-triangular drill boom of the drill boom at any moment; the method comprises the following steps:
step (ii) of1, obtaining a verification Point piThree-dimensional space measurement coordinates relative to the frame coordinate system {0}0pi_C
Step 2, establishing a coordinate system of the double-triangular drilling arm i equal to 1 based on an improved CFDH method;
step 3, establishing a homogeneous coordinate transformation matrix of adjacent joint coordinate systems;
step 4, obtaining a verification point piThe coordinates are calculated in three-dimensional space.
Further, in step 1, a verification point p is obtainediMeasuring coordinates in three-dimensional space relative to a frame coordinate system {0}0pi_CThe specific method comprises the following steps:
step 1.1, establishing a three-dimensional entity model, importing the three-dimensional entity model into software and establishing a virtual prototype;
step 1.2, arranging angle and length sensors; the double-triangular drill arm is provided with 11 joints, wherein 8 joints are rotating joints, 3 joints are moving joints, and an angle sensor and a length sensor are respectively arranged on the 11 joints;
step 1.3, obtaining point p in virtual prototypeiSpatial position coordinates; the method comprises the following steps:
① is set in the virtual prototype, and the sensor theta is set1,θ2,θ3,θ4,d5,θ6,θ7,θ8,θ9,d10,d11Set to a value within any reasonable range. Driving the virtual prototype model to a set value of a sensor;
② Point p1c,p2c,p3c,p4c,p5c,p6c,p7c,p8c,p9c,p10c,p11cRespectively at any point on the joint connecting rods 1-11, and measuring the three-dimensional space measurement coordinates of the points in the virtual prototype to obtain pic={xi_c,yi_c,zi_c}。
Further, in step 2, a specific method for establishing a coordinate system with drill boom i equal to 1 is as follows:
step 2.1, find outA common perpendicular line between the joint axes i and i +1 or the intersection point of the joint axes i and i +1, and the intersection point of the joint axes i and i +1 is taken as an origin O of the drill boom coordinate system { i }i
Step 2.2, specifying the orientation Z along the joint axis ii
Step 2.3, a common perpendicular line from the axis i to i +1 is defined, and if the joint axis i and the joint axis i +1 intersect, X is definediThe axis is perpendicular to the plane of the joint axes i and i +1, and X is determinedi
Step 2.4, determining Y according to the right-hand rulei
Step 2.5, repeating the steps 2.1-2.4, and establishing a coordinate system { X }i,Yi,Zi,Oi}。
Further, in step 3, a specific method for establishing a homogeneous coordinate transformation matrix of adjacent joint coordinate systems is as follows:
step 3.1, defining parameters of adjacent drill boom joints, wherein the parameters are ai-1i-1,dii;ai-1: length of connecting rod along Xi-1Axis from Zi-1Move to Ziαi-1: angle of rotation of connecting rod being around Xi-1Axis from Zi-1Rotate to ZiThe angle of (d); di: offset of connecting rod in Z directioniAxis from Xi-1Move to XiThe distance of (d); thetai: angle of articulation about ZiAxis from Xi-1Rotated to XiThe angle of (d);
step 3.2, defining a homogeneous coordinate transformation matrix of adjacent joint coordinate systems;
① winding coordinate system i-1 around Xi-1Shaft rotation αi-1Angle, Zi-1Axis and ZiThe axes are parallel to obtain a rotation matrix RXi-1)。
Figure BDA0002373195270000031
② locating the coordinate system i-1 along the current Xi-1Translation distance ai-1Let Z bei-1Axis and ZiThe axes coincideTo obtain a translation matrix DXi-1)。
Figure BDA0002373195270000032
Winding the coordinate system i-1 around the current ZiAxis of rotation thetaiAngle, Xi-1Axis and XiThe axes are parallel to obtain a translation matrix DZ(di)。
Figure BDA0002373195270000033
③ along ZiDistance d of shaft translationiThe coordinate system { i-1} is completely overlapped with the coordinate system { i }.
Figure BDA0002373195270000034
3.3, establishing a homogeneous coordinate transformation matrix of adjacent joint coordinate systems; multiplying the four matrixes in the step 3.2 by the four matrixes to obtain a homogeneous transformation matrix of the coordinate system { i } relative to the coordinate system { i-1 }:
Figure BDA0002373195270000035
further, in step 4, a verification point p is obtainediThe specific method for calculating the coordinates in the three-dimensional space comprises the following steps:
step 4.1, homogeneous transformation matrix of coordinate system { i } relative to coordinate system {0} is
Figure BDA0002373195270000041
Figure BDA0002373195270000042
Step 4.2, Point p in coordinate System { i }iHas local coordinates ofipiThen point piThree-dimensional space coordinates relative to the frame coordinate system {0} of
Figure BDA0002373195270000043
Step 4.3, checking the point piThree-dimensional space of (2) calculating coordinates0pi_JAnd measuring coordinates in three-dimensional space in virtual prototype0pi_CWhether they are equal; if they are equal, the parameter a of the joint point i is describedi-1i-1,diiSelecting and converting the matrix and the like correctly, setting i as i +1, repeating the step 2, the step 3 and the step 4, and obtaining the parameters of the joint point i +1 and the conversion matrix; if they are not equal, the parameter a of the joint point i is describedi-1i-1,diiSelecting error, and re-measuring the parameters in the virtual prototype until the error is detected0pi_J0pi_C
The invention has the beneficial effects that: by establishing a virtual prototype, 11 joints are arranged on the double-triangular drill boom, and the spatial position postures of any point and any moment of each joint on the drill boom are determined by a CFDH method and homogeneous coordinates, and the accurate position postures provide important support for the accurate positioning of the fiber rod.
Drawings
FIG. 1 is a flow chart of the operation of the present invention;
FIG. 2 is a virtual prototype of the present invention;
FIG. 3 is a schematic view of the angle and length sensor arrangement of the present invention;
FIG. 4 shows point p of the present inventioniA schematic diagram of measured coordinates of spatial locations;
FIG. 5 is a schematic diagram of a space coordinate system of a drill boom based on a CFDH method according to the present invention;
FIG. 6 is a schematic diagram of coordinates of two adjacent joints;
in the figure, 1-wing type arm base I, 2-wing type arm base II, 3-rear arm cross hinge, 4-drill arm telescopic cylinder barrel, 5-drill arm telescopic cylinder rod, 6-front arm cross hinge, 7-rotary cylinder barrel, 8-rotary cylinder rod, 9-propeller swinging cylinder, 10-propeller compensation cylinder and 11-drilling machine propelling cylinder.
Detailed Description
The invention is described in further detail below with reference to the figures and the embodiments.
The double-triangular drill boom is similar to a multi-joint robot structure, so that the kinematics of the drill boom can be analyzed by using a common theory in robot research, and a method adopted by the analysis is a CFDH (coordinated fixed Denavit-Hartenberg) method, so that the method not only improves the accuracy and operability of the kinematics analysis, but also saves the analysis time and provides an effective means for establishing a kinematics equation. The homogeneous matrix change is suitable for describing the transformation relation among a plurality of coordinates due to the intuitive geometrical significance of the homogeneous matrix change. Furthermore, homogeneous matrix changes can also represent the transformation of rotation and displacement by using the same matrix, and the characteristic makes the homogeneous matrix change widely used in the kinematics research of multi-joint robots.
The method comprises the steps of firstly, carrying out three-dimensional modeling on parts on the double-triangular drill boom by using Pro/E software, assembling all established part models according to actual installation requirements to further obtain a three-dimensional model of the double-triangular drill boom, then introducing the three-dimensional model of the double-triangular drill boom into ADMAS software, obtaining a virtual prototype of the drill boom through corresponding processing, and simulating the drill boom. And (3) establishing a coordinate system of the double-triangular drill boom by using a CFDH method, and then establishing a homogeneous coordinate transformation matrix of adjacent joint coordinate systems to obtain a kinematic equation of the double-triangular drill boom. And (3) verifying the kinematic equation by using virtual prototype simulation, and if the kinematic equation passes the verification, obtaining the coordinate value of the real-time position posture of the double-triangular drill arm accurately. FIG. 1 is a flow chart of the method. The method for acquiring the spatial position attitude of the double triangular drill booms of the drill jumbo in real time comprises the following steps: step 1, obtaining verification point piMeasured coordinates in three-dimensional space relative to the frame coordinate system {0}0pi_C
Step 1.1, establishing a three-dimensional entity model, importing the three-dimensional entity model into software to establish a virtual prototype, and displaying the virtual prototype in a figure 2.
The computer drill jumbo drill boom is a direct positioning double-triangular drill boom, has 8 rotating joints and 3 moving joints, and is a joint type drill boom with multiple degrees of freedom. Respectively is a wing type arm seat I1, a wing type arm seat II2, a rear arm cross hinge 3, a drill arm telescopic cylinder barrel 4, a drill arm telescopic cylinder rod 5, a front arm cross hinge 6, a rotary cylinder barrel 7, a rotary cylinder rod 8, a propeller swinging cylinder 9, a propeller compensating cylinder 10 and a drilling machine propelling cylinder 11.
Step 1.2, arranging angle and length sensors, as shown in figure 3. The eleven sensors are respectively:
r1: an angle sensor 1 for measuring the lifting angle theta of the wing-type arm seat I1
R2: an angle sensor 2 for measuring the lifting angle theta of the wing type arm seat II2. Remarking: the sensor is not installed in a real object, the angle of the sensor is ensured by a parallel four-bar linkage mechanism of the wing type arm, and the angle is a negative value of the sequence 1 angle. The sensor is installed in the virtual prototype.
R3: an angle sensor 3 for measuring the left-right swing angle theta of the boom3
R4: an angle sensor 4 for measuring the up-down lifting angle theta of the big arm4
R5: a length sensor 5 for measuring the fore-and-aft telescopic length d of the boom5
R6: an angle sensor 6 for measuring the vertical lifting angle theta of the propeller6
R7: an angle sensor 7 for measuring the left-right swing angle theta of the propeller7
R8: an angle sensor 8 for measuring a propeller rotation angle θ8
R9: an angle sensor 9 for measuring a propeller pitch angle theta9
R10: a length sensor 10 for measuring the extension length d of the propeller10
R11: a length sensor 11 for measuring the telescopic length d of the rock drill11
Step 1.3, obtaining point p in virtual prototypeiSpatial position coordinates.
① is set in the virtual prototype, and the sensor theta is set1,θ2,θ3,θ4,d5,θ6,θ7,θ8,θ9,d10,d11Set to a value within any reasonable range. The virtual prototype model is driven to the sensor settings.
② Point p1c,p2c,p3c,p4c,p5c,p6c,p7c,p8c,p9c,p10c,p11cRespectively at any point on the joint connecting rods 1-11, and measuring the three-dimensional space measurement coordinates of the points in the virtual prototype to obtain pic={xi_c,yi_c,zi_cAs shown in fig. 4.
And 2, establishing a drill boom i-1 coordinate system based on an improved CFDH method.
Step 2.1, finding out a common perpendicular line between the joint axes i and i +1 or an intersection point of the joint axes and i +1, and taking the intersection point of the joint axes i and i +1 as an origin O of a drill boom coordinate system { i }, whereini
Step 2.2, specifying the orientation Z along the joint axis ii
Step 2.3, a common perpendicular line from the axis i to i +1 is defined, and if the joint axis i and the joint axis i +1 intersect, X is definediThe axis is perpendicular to the plane of the joint axes i and i +1, and X is determinedi
Step 2.4, determining Y according to the right-hand ruleiWherein i is 0,1,2,3,4,5,6,7,8,9,10, 11.
Repeating the steps 2.1-2.4, and establishing a coordinate system { X }i,Yi,Zi,OiAnd (6) establishing a space coordinate system shown in the attached figure 4. And 3, establishing a homogeneous coordinate transformation matrix of adjacent joint coordinate systems.
Step 3.1, defining parameters of adjacent drill boom joints, wherein the parameters are ai-1i-1,diiSee fig. 6.
ai-1: length of connecting rod along Xi-1Axis from Zi-1Move to ZiThe distance of (d);
αi-1: angle of rotation of connecting rod being around Xi-1Axis from Zi-1Rotate to ZiThe angle of (d);
di: offset of connecting rod in Z directioniAxis from Xi-1Move to XiThe distance of (d);
θi: angle of articulation about ZiAxis from Xi-1Rotated to XiThe angle of (d);
step 3.2, defining homogeneous coordinate transformation matrix of adjacent joint coordinate systems
① winding coordinate system i-1 around Xi-1Shaft rotation αi-1Angle, Zi-1Axis and ZiThe axes are parallel to obtain a rotation matrix RXi-1)。
Figure BDA0002373195270000071
② locating the coordinate system i-1 along the current Xi-1Translation distance ai-1Let Z bei-1Axis and ZiThe axes are superposed to obtain a translation matrix DXi-1)。
Figure BDA0002373195270000072
Winding the coordinate system i-1 around the current ZiAxis of rotation thetaiAngle, Xi-1Axis and XiThe axes are parallel to obtain a translation matrix DZ(di)。
Figure BDA0002373195270000081
Along ZiDistance d of shaft translationiThe coordinate system { i-1} is completely overlapped with the coordinate system { i }.
Figure BDA0002373195270000082
And 3.3, establishing a homogeneous coordinate transformation matrix of adjacent joint coordinate systems. Multiplying the four matrices by this may result in a homogeneous transformation matrix for coordinate system { i } relative to coordinate system { i-1 }:
Figure BDA0002373195270000083
in the above formula, c represents cos and s represents sin.
Step 4, obtaining a verification point piThe coordinates are calculated in three-dimensional space.
Step 4.1, homogeneous transformation matrix of coordinate system { i } relative to coordinate system {0} is
Figure BDA0002373195270000084
Figure BDA0002373195270000085
Step 4.2, Point p in coordinate System { i }iHas local coordinates ofipiThen point piThree-dimensional space coordinates relative to the frame coordinate system {0} of
Figure BDA0002373195270000086
Step 4.3, checking the point piThree-dimensional space of (2) calculating coordinates0pi_JAnd measuring coordinates in three-dimensional space in virtual prototype0pi_CWhether or not equal.
①, equal, indicate the parameter a of the joint point ii-1i-1,diiThe selection, transformation matrix, etc. are correct.
Setting i as i +1, repeating the step 2, the step 3 and the step 4, and obtaining parameters and transformation matrixes of the joint points i + 1.
② if they are not equal, the parameter a of the joint point i is describedi-1i-1,diiSelecting error, and re-measuring the parameters in the virtual prototype until the error is detected0pi_J0pi_C
And 5, acquiring joint parameters of the drill boom model.
Step 5.1, after step 4 has been performed, four parameters of the joints 1-11 are obtained which are verified as correct, as followsShown in table 1. d2,d3,d7,d8,d9,d11,a2,a3,a4,a7,a9,a11Is a known quantity, is determined by the inherent geometrical parameters of the drill boom in step 4. Theta1,θ3,θ4,d5,θ6,θ7,θ8,θ9,d10The input quantity is measured by each sensor in step 1.
Figure BDA0002373195270000091
Step 5.2, according to the table, homogeneous transformation matrix between adjacent joint coordinate systems of the mechanical armIn this example, the following is:
Figure BDA0002373195270000093
Figure BDA0002373195270000101
step 5.3, for any point on any part of the drill boomipiSpatial attitude at any time0piComprises the following steps:
Figure BDA0002373195270000102
wherein
Figure BDA0002373195270000103
From step 5.2.
The embodiments of the present invention have been described in detail with reference to the accompanying drawings, but the present invention is not limited thereto, and various changes which can be made within the knowledge of those skilled in the art without departing from the gist of the present invention are within the scope of the claims of the present invention.

Claims (5)

1. A method for acquiring the spatial position and attitude of a double-triangular drill boom of a drill jumbo in real time is characterized by comprising the following steps of: the method comprises the steps of establishing a three-dimensional model of the double-triangular drill boom, then establishing a virtual prototype, and performing kinematic simulation on the double-triangular drill boom; establishing a kinematic equation of the double-triangular drill boom according to a CFDH method, and comparing a simulation result of a virtual prototype with the kinematic equation to verify the correctness of the kinematic equation so as to obtain the accurate position posture of the double-triangular drill boom of the drill boom at any moment; the method comprises the following steps:
step 1, obtaining a verification point piThree-dimensional space measurement coordinates relative to the frame coordinate system {0}0pi_C
Step 2, establishing a coordinate system of the double-triangular drilling arm i equal to 1 based on an improved CFDH method;
step 3, establishing a homogeneous coordinate transformation matrix of adjacent joint coordinate systems;
step 4, obtaining a verification point piThe coordinates are calculated in three-dimensional space.
2. A method of obtaining in real time attitude of spatial positions of dual-gimbals of a rock drilling rig as claimed in claim 1, characterized by: in step 1, a verification point p is obtainediMeasuring coordinates in three-dimensional space relative to a frame coordinate system {0}0pi_CThe specific method comprises the following steps:
step 1.1, establishing a three-dimensional entity model of a double-triangular drill arm, and importing the three-dimensional entity model into software to establish a virtual prototype;
step 1.2, arranging angle and length sensors: the double-triangular drill arm is provided with 11 joints, wherein 8 joints are rotating joints, 3 joints are moving joints, and an angle sensor and a length sensor are respectively arranged on the 11 joints;
step 1.3, obtaining point p in virtual prototypeiSpatial position coordinates; the method comprises the following steps:
① in the virtual prototype, the angle and displacement of the sensor in step 1.2 are measured
θ1234,d56789,d10,d11Setting the value in any reasonable range, and driving the virtual prototype model to the set value of the sensor;
② Point p1c,p2c,p3c,p4c,p5c,p6c,p7c,p8c,p9c,p10c,p11cRespectively at any point on the joint connecting rods 1-11, and measuring the three-dimensional space measurement coordinates of the points in the virtual prototype to obtain pic={xi_c,yi_c,zi_c}。
3. A method of obtaining in real time attitude of spatial positions of dual-gimbals of a rock drilling rig as claimed in claim 1, characterized by: in step 2, a specific method for establishing a coordinate system with drill boom i equal to 1 is as follows:
step 2.1, finding out a common perpendicular line between the joint axes i and i +1 or an intersection point of the joint axes i and i +1, and taking the intersection point of the joint axes i and i +1 as an origin O of a drill boom coordinate system { i }, whereini
Step 2.2, specifying the orientation Z along the joint axis ii
Step 2.3, a common perpendicular line from the axis i to i +1 is defined, and if the joint axis i and the joint axis i +1 intersect, X is definediThe axis is perpendicular to the plane of the joint axes i and i +1, and X is determinedi
Step 2.4, determining Y according to the right-hand rulei
Step 2.5, repeating the steps 2.1-2.4, and establishing a coordinate system { X }i,Yi,Zi,Oi}。
4. A method of obtaining in real time attitude of spatial positions of dual-gimbals of a rock drilling rig as claimed in claim 1, characterized by: in step 3, the specific method for establishing the homogeneous coordinate transformation matrix of the adjacent joint coordinate system comprises the following steps:
step 3.1, defining the joint parameters of adjacent drill booms, which are respectivelyai-1i-1,dii;ai-1: length of connecting rod along Xi-1Axis from Zi-1Move to Ziαi-1: angle of rotation of connecting rod being around Xi-1Axis from Zi-1Rotate to ZiThe angle of (d); di: offset of connecting rod in Z directioniAxis from Xi-1Move to XiThe distance of (d); thetai: angle of articulation about ZiAxis from Xi-1Rotated to XiThe angle of (d);
step 3.2, defining a homogeneous coordinate transformation matrix of adjacent joint coordinate systems;
winding the coordinate system { i-1} around Xi-1Shaft rotation αi-1Angle, Zi-1Axis and ZiThe axes are parallel to obtain a rotation matrix RXi-1);
Figure FDA0002373195260000021
Coordinate system i-1 along current Xi-1Translation distance ai-1Let Z bei-1Axis and ZiThe axes are superposed to obtain a translation matrix DXi-1);
Figure FDA0002373195260000022
Winding the coordinate system i-1 around the current ZiAxis of rotation thetaiAngle, Xi-1Axis and XiThe axes are parallel to obtain a translation matrix DZ(di);
Figure FDA0002373195260000023
Along ZiDistance d of shaft translationiMaking the coordinate system { i-1} completely coincide with the coordinate system { i };
Figure FDA0002373195260000024
3.3, establishing a homogeneous coordinate transformation matrix of adjacent joint coordinate systems; multiplying the four matrixes in the step 3.2 by the four matrixes to obtain a homogeneous transformation matrix of the coordinate system { i } relative to the coordinate system { i-1 }:
Figure FDA0002373195260000031
5. a method of obtaining in real time attitude of spatial positions of dual-gimbals of a rock drilling rig as claimed in claim 1, characterized by: in step 4, a verification point p is obtainediThe specific method for calculating the coordinates in the three-dimensional space comprises the following steps:
step 4.1, homogeneous transformation matrix of coordinate system { i } relative to coordinate system {0} is
Figure FDA0002373195260000032
Step 4.2, Point p in coordinate System { i }iHas local coordinates ofipiThen point piThree-dimensional space coordinates relative to the frame coordinate system {0} of0pi_J
Figure FDA0002373195260000033
Step 4.3, checking the point piThree-dimensional space of (2) calculating coordinates0pi_JAnd measuring coordinates in three-dimensional space in virtual prototype0pi_CWhether they are equal; if they are equal, the parameter a of the joint point i is describedi-1i-1,diiSelecting and converting the matrix and the like correctly, setting i as i +1, repeating the step 2, the step 3 and the step 4, and obtaining the parameters of the joint point i +1 and the conversion matrix; if they are not equal, the parameter a of the joint point i is describedi-1i-1,diiSelecting error, and re-measuring the parameters in the virtual prototype until the error is detected0pi_J0pi_C
CN202010057135.7A 2020-01-19 2020-01-19 Method for acquiring spatial position and posture of double-triangle drill boom of drill jumbo in real time Active CN111274696B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010057135.7A CN111274696B (en) 2020-01-19 2020-01-19 Method for acquiring spatial position and posture of double-triangle drill boom of drill jumbo in real time

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010057135.7A CN111274696B (en) 2020-01-19 2020-01-19 Method for acquiring spatial position and posture of double-triangle drill boom of drill jumbo in real time

Publications (2)

Publication Number Publication Date
CN111274696A true CN111274696A (en) 2020-06-12
CN111274696B CN111274696B (en) 2024-01-09

Family

ID=70998747

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010057135.7A Active CN111274696B (en) 2020-01-19 2020-01-19 Method for acquiring spatial position and posture of double-triangle drill boom of drill jumbo in real time

Country Status (1)

Country Link
CN (1) CN111274696B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112746812A (en) * 2021-01-22 2021-05-04 安百拓(南京)建筑矿山设备有限公司 Illumination and camera shooting follow-up system and control method of drill jumbo and drill jumbo
CN112861361A (en) * 2021-02-20 2021-05-28 中国铁建重工集团股份有限公司 Working space simulation method based on drill jumbo
CN113894790A (en) * 2021-11-04 2022-01-07 洛阳银杏科技有限公司 Rock drilling robot drill boom motion control method based on tail end attitude constraint

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107885916A (en) * 2017-10-27 2018-04-06 西安工业大学 A kind of drill jumbo drill boom Analytical Methods of Kinematics based on CFDH methods

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107885916A (en) * 2017-10-27 2018-04-06 西安工业大学 A kind of drill jumbo drill boom Analytical Methods of Kinematics based on CFDH methods

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
宫珊珊 等: "关节臂式坐标测量机的虚拟样机模型及仿真" *
徐勤宪;郭治富;: "锚杆钻车三角钻臂的运动学研究" *

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112746812A (en) * 2021-01-22 2021-05-04 安百拓(南京)建筑矿山设备有限公司 Illumination and camera shooting follow-up system and control method of drill jumbo and drill jumbo
CN112861361A (en) * 2021-02-20 2021-05-28 中国铁建重工集团股份有限公司 Working space simulation method based on drill jumbo
CN112861361B (en) * 2021-02-20 2023-04-11 中国铁建重工集团股份有限公司 Working space simulation method based on drill jumbo
CN113894790A (en) * 2021-11-04 2022-01-07 洛阳银杏科技有限公司 Rock drilling robot drill boom motion control method based on tail end attitude constraint

Also Published As

Publication number Publication date
CN111274696B (en) 2024-01-09

Similar Documents

Publication Publication Date Title
CN111274696B (en) Method for acquiring spatial position and posture of double-triangle drill boom of drill jumbo in real time
CN109794938B (en) Robot hole-making error compensation device and method suitable for curved surface structure
CN107717993B (en) Efficient and convenient simple robot calibration method
CN108789404A (en) A kind of serial manipulator kinematic calibration method of view-based access control model
CN110757504B (en) Positioning error compensation method of high-precision movable robot
CN111055273B (en) Two-step error compensation method for robot
CN109176505B (en) Ball arm instrument-based six-axis joint industrial robot spatial error calibration method
CN104890013A (en) Pull-cord encoder based calibration method of industrial robot
CN103899338B (en) Hydraulic support working posture determining method based on space coordinate converting
CN109664328B (en) Tool calibration method of SCARA robot
CN110815206A (en) Stewart type parallel robot kinematics calibration method
CN108655827A (en) Five-axle number control machine tool space error discrimination method
JPS60199194A (en) Drilling method
CN109176488A (en) A kind of flexible robot's Kinematic Calibration method and system
CN113445907B (en) Drilling method of drill jumbo, drilling quality evaluation method and system and drill jumbo
CN112936273A (en) Speed-level kinematics modeling method of rope-driven flexible mechanical arm
CN112828878B (en) Three-dimensional measurement and tracking method for large-scale equipment in butt joint process
JP5378908B2 (en) Robot accuracy adjustment method and robot
CN113240753A (en) Sphere fitting method for calibrating base coordinate system of robot and double-shaft deflection mechanism
CN100501109C (en) Method for measuring and locating virtual tetrahedron top of abnormity component
CN117306614A (en) Excavator bucket operation track determination method, device, equipment and storage medium
CN114922179A (en) Side-clamping type hydraulic pile driver pose monitoring system and pose inverse solution method thereof
CN111075489B (en) Attitude description method for floating connection mechanism of hydraulic support and scraper conveyor
CN105783806A (en) Virtual-prototype-based sampling simulation method for articulated coordinate measuring machine
CN114454167B (en) Method for calibrating geometric dimension of tail end clamp holder of dental implant robot

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
CB02 Change of applicant information
CB02 Change of applicant information

Address after: 221137 No. 3, Xugong Avenue, Qingshanquan Town, Jiawang District, Xuzhou, Jiangsu Province

Applicant after: Xuzhou XCMG Energy Equipment Co.,Ltd.

Address before: No.1 Dahuangshan Road, Xuzhou Economic and Technological Development Zone, Jiangsu Province

Applicant before: XCMG RAILWAY EQUIPMENT Co.,Ltd.

GR01 Patent grant
GR01 Patent grant