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 PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 40
- 238000005553 drilling Methods 0.000 claims abstract description 18
- 238000004088 simulation Methods 0.000 claims abstract description 6
- 239000011159 matrix material Substances 0.000 claims description 38
- 230000009466 transformation Effects 0.000 claims description 23
- 238000013519 translation Methods 0.000 claims description 12
- 238000012795 verification Methods 0.000 claims description 11
- 239000011435 rock Substances 0.000 claims description 8
- 238000004804 winding Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 238000006073 displacement reaction Methods 0.000 claims description 2
- 230000036544 posture Effects 0.000 description 6
- 230000008859 change Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000010276 construction Methods 0.000 description 2
- 239000000835 fiber Substances 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- RZVAJINKPMORJF-UHFFFAOYSA-N Acetaminophen Chemical compound CC(=O)NC1=CC=C(O)C=C1 RZVAJINKPMORJF-UHFFFAOYSA-N 0.000 description 1
- QEIQEORTEYHSJH-UHFFFAOYSA-N Armin Natural products C1=CC(=O)OC2=C(O)C(OCC(CCO)C)=CC=C21 QEIQEORTEYHSJH-UHFFFAOYSA-N 0.000 description 1
- 125000000174 L-prolyl group Chemical group [H]N1C([H])([H])C([H])([H])C([H])([H])[C@@]1([H])C(*)=O 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000005422 blasting Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Chemical compound O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
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
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;
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-1,αi-1,di,θi;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 RX(αi-1)。
② 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 DX(αi-1)。
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)。
③ along ZiDistance d of shaft translationiThe coordinate system { i-1} is completely overlapped with the coordinate system { i }.
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 }:
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
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
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-1,αi-1,di,θiSelecting 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-1,αi-1,di,θiSelecting error, and re-measuring the parameters in the virtual prototype until the error is detected0pi_J=0pi_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-1,αi-1,di,θiSee 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 RX(αi-1)。
② 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 DX(αi-1)。
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)。
Along ZiDistance d of shaft translationiThe coordinate system { i-1} is completely overlapped with the coordinate system { i }.
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 }:
in the above formula, c represents cos and s represents sin.
Step 4.1, homogeneous transformation matrix of coordinate system { i } relative to coordinate system {0} is
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
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-1,αi-1,di,θiThe 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-1,αi-1,di,θiSelecting error, and re-measuring the parameters in the virtual prototype until the error is detected0pi_J=0pi_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.
Step 5.2, according to the table, homogeneous transformation matrix between adjacent joint coordinate systems of the mechanical armIn this example, the following is:
step 5.3, for any point on any part of the drill boomipiSpatial attitude at any time0piComprises the following steps:
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
θ1,θ2,θ3,θ4,d5,θ6,θ7,θ8,θ9,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-1,αi-1,di,θi;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 RX(αi-1);
Coordinate system i-1 along current Xi-1Translation distance ai-1Let Z bei-1Axis and ZiThe axes are superposed to obtain a translation matrix DX(αi-1);
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);
Along ZiDistance d of shaft translationiMaking the coordinate system { i-1} completely coincide with the coordinate system { i };
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 }:
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
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:
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-1,αi-1,di,θiSelecting 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-1,αi-1,di,θiSelecting error, and re-measuring the parameters in the virtual prototype until the error is detected0pi_J=0pi_C。
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)
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)
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 |
-
2020
- 2020-01-19 CN CN202010057135.7A patent/CN111274696B/en active Active
Patent Citations (1)
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)
Title |
---|
宫珊珊 等: "关节臂式坐标测量机的虚拟样机模型及仿真" * |
徐勤宪;郭治富;: "锚杆钻车三角钻臂的运动学研究" * |
Cited By (4)
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 |