CN113818816A - Mechanical arm collision detection method for multi-arm rock drilling robot - Google Patents

Mechanical arm collision detection method for multi-arm rock drilling robot Download PDF

Info

Publication number
CN113818816A
CN113818816A CN202110897171.9A CN202110897171A CN113818816A CN 113818816 A CN113818816 A CN 113818816A CN 202110897171 A CN202110897171 A CN 202110897171A CN 113818816 A CN113818816 A CN 113818816A
Authority
CN
China
Prior art keywords
arm
rock drilling
rectangular projection
tunnel
polar angle
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.)
Withdrawn
Application number
CN202110897171.9A
Other languages
Chinese (zh)
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.)
Luoyang Ginkgo Technology Co ltd
Original Assignee
Luoyang Ginkgo Technology 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 Luoyang Ginkgo Technology Co ltd filed Critical Luoyang Ginkgo Technology Co ltd
Priority to CN202110897171.9A priority Critical patent/CN113818816A/en
Publication of CN113818816A publication Critical patent/CN113818816A/en
Withdrawn legal-status Critical Current

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E21EARTH OR ROCK DRILLING; MINING
    • E21BEARTH OR ROCK DRILLING; OBTAINING OIL, GAS, WATER, SOLUBLE OR MELTABLE MATERIALS OR A SLURRY OF MINERALS FROM WELLS
    • E21B15/00Supports for the drilling machine, e.g. derricks or masts

Landscapes

  • Engineering & Computer Science (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Geology (AREA)
  • Mining & Mineral Resources (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Environmental & Geological Engineering (AREA)
  • Fluid Mechanics (AREA)
  • General Life Sciences & Earth Sciences (AREA)
  • Geochemistry & Mineralogy (AREA)
  • Earth Drilling (AREA)

Abstract

A mechanical arm collision detection method for a multi-arm rock drilling robot comprises the following steps: s1, converting a mechanical arm of the rock drilling robot into a set of a plurality of cylindrical enveloping boxes, converting the top wall of the tunnel into an arc line segment and constructing a fan-shaped detection surface based on the arc line segment; s2, detecting the minimum distance value between any two cylinder enveloping boxes in real time in the action process of the rock drilling robot to judge whether the mechanical arms collide; and S3, judging whether the mechanical arm collides with the top wall of the tunnel or not based on the projection of the cylindrical envelope box on the detection surface. The invention provides a mechanical arm collision detection method for a multi-arm rock drilling robot, which can accurately and comprehensively detect the collision condition of the rock drilling robot in real time, so that the system can give early warning in time to avoid collision interference accidents, and has strong real-time performance and higher efficiency.

Description

Mechanical arm collision detection method for multi-arm rock drilling robot
Technical Field
The invention relates to the field of rock drilling robots, in particular to a mechanical arm collision detection method for a multi-arm rock drilling robot.
Background
At present, the multi-arm rock drilling robot is widely applied to the work of coal mines, tunnel excavation and the like. Because the rock drilling robot belongs to industrial hydraulic heavy-duty mechanical arms and has the characteristics of multi-arm cooperation, complex structure and the like, the mechanical arms are easy to collide and interfere during operation in a tunnel, and extremely large casualties and economic losses can be caused in severe cases, so that the collision detection problem of the multi-arm rock drilling robot needs to be solved urgently.
Numerous scholars have hitherto studied on collision detection of a rock drilling robot, and are mainly classified into a collision detection method based on an external sensor, a collision detection method based on vision, and a collision detection method implemented by modeling. For an industrial hydraulic heavy-load robot, the collision detection method realized by modeling is easy to realize and high in data processing efficiency, so that the collision method realized by depending on modeling at present is widely applied. The method generally simplifies the robot model, and realizes the collision detection of the robot by calculating the space geometric model distance.
The first is to adopt sphere and capsule body bounding box to simplify the mechanical arm model, can realize effectual collision detection, but because of the mechanical structure's of mechanical arm joint irregularity, use the sphere envelope can cause certain influence to detecting the precision.
And thirdly, a space convex polyhedron model is used for modeling a complex object, so that collision detection can be accurately realized, but the tunnel wall where the rock drilling robot is located is relatively regular, and the collision detection efficiency of the robot and the tunnel can be reduced by using the method. The rock drilling robot collision detection research developed by depending on modeling is mostly applied among a plurality of mechanical arms of the rock drilling robot, so that the collision detection research of the mechanical arms of the rock drilling robot and a tunnel is less, and further deep research is still needed. Meanwhile, in the collision detection method realized by depending on modeling, the efficiency and the precision of a detection algorithm can be reduced by a complex modeling method and a complex calculation method.
And the third method is to adopt a cylinder bounding box to simplify a mechanical arm model and realize collision detection based on space vector operation, and compared with the first method, the method has higher precision and is simpler than the second method, but the existing method is still very complex and has lower implementation efficiency.
Disclosure of Invention
In order to solve the defects in the prior art, the invention provides a mechanical arm collision detection method for a multi-arm rock drilling robot, which can accurately and comprehensively detect the collision condition of the rock drilling robot in real time, so that the system can give early warning in time to avoid collision interference accidents, and has strong real-time performance and higher efficiency.
In order to achieve the purpose, the invention adopts the specific scheme that: a mechanical arm collision detection method for a multi-arm rock drilling robot comprises the following steps:
s1, converting a mechanical arm of the rock drilling robot into a set of a plurality of cylindrical enveloping boxes, converting the top wall of the tunnel into an arc line segment and constructing a fan-shaped detection surface based on the arc line segment;
s2, detecting the minimum distance value between any two cylinder enveloping boxes in real time in the action process of the rock drilling robot to judge whether the mechanical arms collide;
and S3, judging whether the mechanical arm collides with the top wall of the tunnel or not based on the projection of the cylindrical envelope box on the detection surface.
As a further optimization of the above described mechanical arm collision detection method for a multi-arm rock drilling robot: in the S1, the mechanical arm comprises a working arm and a hanging basket arm, the working arm and the hanging basket arm respectively comprise two or more action parts, and all the action parts are converted into a cylindrical enveloping box;
respectively marking two end points of the arc segment as T1And T2If the center of the arc line is marked as O, the detection surface is sector T1OT2Radius R and pole O, OT2A polar coordinate system is constructed for the polar axis.
As the mechanical arm collision detection method for the multi-arm rock drilling robotFurther optimization of the method: in S2, if the minimum distance between the axes of the two cylindrical envelope boxes involved in the detection is d, the minimum distance between the two cylindrical envelope boxes is dmin=d-(r1+r2) Wherein r is1And r2Respectively, the radius of two cylinders enveloping the box, if dminIf the number is more than 0, the action parts corresponding to the two cylindrical envelope boxes do not collide, otherwise, the action parts corresponding to the two cylindrical envelope boxes collide.
As a further optimization of the above described mechanical arm collision detection method for a multi-arm rock drilling robot: in S2, the method of calculating the minimum distance d between the two cylinder axes is:
s21, recording the axial line segment of the two cylinder envelope boxes as l1And l2,l1Respectively has two end point coordinates of P1(x1,y1,z1) And P2(x2,y2,z2),l2Are respectively Q1(x3,y3,z3) And Q2(x4,y4,z4) Then l is1And l2The coordinates of any point above can be expressed as:
Figure RE-GDA0003298599180000021
wherein the vector
Figure RE-GDA0003298599180000022
(Vector)
Figure RE-GDA0003298599180000023
λ1And λ2Is a coefficient;
s22, converting the solving process of the minimum distance d into a solving coefficient lambda1And λ2The process of the optimal solution of (a) is,
Figure RE-GDA0003298599180000024
s23 minimum-based condition
Figure RE-GDA0003298599180000025
The formula in S22 is simplified to obtain
Figure RE-GDA0003298599180000031
S24, when 0 is not more than lambda12D is less than or equal to 12=f(λ12) Otherwise, executing S25;
s25, when
Figure RE-GDA0003298599180000032
Or
Figure RE-GDA0003298599180000033
Then, P is calculated separately1To l2Distance d of1、P2To l2Distance d of2、Q1To l1Distance d of3And Q2To l2Distance d of4And has d ═ d1,d2,d3,d4}min
As a further optimization of the above described mechanical arm collision detection method for a multi-arm rock drilling robot: the specific method of S3 is as follows:
s31, simplifying the projection of the cylindrical envelope box on the detection surface into a rectangle, and respectively recording the two ends of the axial projection of the cylindrical envelope box as K1And K2In polar coordinates, will K1、K2、T1And T2Is described as
Figure RE-GDA0003298599180000034
Figure RE-GDA0003298599180000035
And
Figure RE-GDA0003298599180000036
and is provided with
Figure RE-GDA0003298599180000037
β2=0;
S32, when K1And K2Medium maximum polar angle less than T1And T2Minimum polar angle or K in1And K2Medium minimum polar angle greater than T1And T2At the maximum polar angle of (1), the rectangular projection falls entirely within the sector T1OT2Outside the range, the rectangular projection and the arc line section have no interference, and the action part corresponding to the rectangular projection does not collide with the top wall of the tunnel;
when T is1And T2Maximum polar angle of between K1And K2Between the minimum and maximum polar angles and T1And T2Has a minimum polar angle of less than K1And K2At the smallest polar angle of (1), K is the intersection of the rectangular projection axis and the fan-shaped edge, if
Figure RE-GDA0003298599180000038
Figure RE-GDA0003298599180000039
The rectangular projection and the arc line segment do not interfere with each other and the action part corresponding to the rectangular projection does not collide with the top wall of the tunnel, otherwise, the rectangular projection and the arc line segment interfere with each other and the action part corresponding to the rectangular projection collides with the top wall of the tunnel;
when T is1And T2Has a minimum polar angle between K1And K2Between the minimum and maximum polar angles and T1And T2Has a maximum polar angle greater than K1And K2At the maximum polar angle of (1), K is the intersection of the rectangular projection axis and the fan-shaped edge, if
Figure RE-GDA00032985991800000310
Figure RE-GDA00032985991800000311
The rectangular projection does not interfere with the arc line segment and the action part corresponding to the rectangular projection does not emit light from the top wall of the tunnelCollision occurs, otherwise, the rectangular projection interferes with the arc line segment, and the action part corresponding to the rectangular projection collides with the top wall of the tunnel;
when K is1And K2The middle maximum polar angle and the minimum polar angle are both between T1And T2In between the minimum polar angle and the maximum polar angle, if
Figure RE-GDA00032985991800000312
And if not, the rectangular projection interferes with the arc line segment and the action part corresponding to the rectangular projection collides with the top wall of the tunnel.
As a further optimization of the above described mechanical arm collision detection method for a multi-arm rock drilling robot: in S3, the length of OK is d1Then calculate d1The method comprises the following steps:
computing
Figure RE-GDA0003298599180000041
The vector dot product formula can be used for obtaining
Figure RE-GDA0003298599180000042
From the trigonometric cosine theorem
Figure RE-GDA0003298599180000043
Has the advantages that: according to the method, firstly, a collision detection model of the rock drilling robot is established, a rod piece of a mechanical arm is simplified into a cylindrical envelope box according to the structural characteristics of the robot, collision detection of a single drill arm, among three drill arms and a hanging basket arm of the rock drilling robot is realized by constantly calculating the distance of each cylindrical envelope box in space, collision detection of the rock drilling robot and a tunnel is quickly realized by analyzing and calculating the interference condition of rectangular projection of the cylindrical envelope box on the wall surface of the tunnel and the wall surface of the tunnel, the collision condition of the rock drilling robot can be detected accurately and comprehensively in real time, and the system can give early warning in time so as to avoid collision interference accidents, and is strong in real-time performance and higher in efficiency.
Drawings
FIG. 1 is a schematic diagram of a construction mode of a cylindrical envelope box;
fig. 2 is a schematic diagram of the judgment of whether or not a collision occurs between the robot arms in S2;
FIG. 3 is a schematic view of a detection surface;
FIG. 4 is a schematic diagram of a simplified model of a tunnel;
FIG. 5 is a schematic diagram A of the relative relationship between the rectangular projection and the detection surface;
fig. 6 is a schematic diagram B of the relative relationship between the rectangular projection and the detection surface.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
A mechanical arm collision detection method for a multi-arm rock drilling robot comprises the following steps:
s1, converting mechanical arms of the rock drilling robot into a set of a plurality of cylinder enveloping boxes, converting the top wall of the tunnel into an arc line segment and constructing a fan-shaped detection surface based on the arc line segment. In S1, the mechanical arm comprises a working arm and a hanging basket arm, the working arm and the hanging basket arm respectively comprise two or more action parts, and all the action parts are converted into a cylindrical envelope box. As shown in FIG. 3, two end points of the arc segment are respectively denoted as T1And T2If the center of the arc line is marked as O, the detection surface is sector T1OT2Radius R and pole O, OT2A polar coordinate system is constructed for the polar axis.
The rock drilling robot has a complex structure, for example, a medium iron DJ3E multi-arm rock drilling robot, which includes three drilling booms and a basket boom, wherein the three drilling booms have the same structure, and during the working process, collisions may occur between the drilling booms and the drilling booms, between the drilling booms and the basket boom, and between the drilling booms or the basket boom and the tunnel wall, and if each working boom is accurately modeled, the engineering amount is too large, and the implementation efficiency is low, so the invention uses the cylinder envelope boxes to model the working booms, each working boom may include a plurality of cylinder envelope boxes, as shown in fig. 1, the drilling booms may include four cylinder envelope boxes CS1, CS2, CS3 and CS4, and the basket boom may include two cylinder envelope boxes CS5 and CS6, modeling the working booms using the cylinder envelope boxes can effectively reduce the complexity of the model, and further reduce the difficulty of the implementation method, the operation efficiency is improved.
And S2, detecting the minimum distance value between any two cylinder enveloping boxes in real time in the action process of the rock drilling robot to judge whether the mechanical arms collide. As shown in fig. 2, in S2, if the distance between the axes of the two cylinder enveloping boxes participating in the detection is d, the minimum distance between the two cylinder enveloping boxes is dmin=d-(r1+r2) Wherein r is1And r2Respectively, the radius of two cylinders enveloping the box, if dminIf the number is more than 0, the action parts corresponding to the two cylindrical envelope boxes do not collide, otherwise, the action parts corresponding to the two cylindrical envelope boxes collide.
Calculating the minimum distance dminThe method of (1) is S21 to S25.
S21, recording the axial line segment of the two cylinder envelope boxes as l1And l2,l1Respectively has two end point coordinates of P1(x1,y1,z1) And P2(x2,y2,z2),l2Are respectively Q1(x3,y3,z3) And Q2(x4,y4,z4) Then l is1And l2The coordinates of any point above can be expressed as:
Figure RE-GDA0003298599180000051
wherein the vector
Figure RE-GDA0003298599180000052
(Vector)
Figure RE-GDA0003298599180000053
λ1And λ2Are coefficients.
S22, setting the minimum distance dminIs converted into a coefficient lambda1And λ2The process of solving the optimal solution of the method,
Figure RE-GDA0003298599180000054
s23 minimum-based condition
Figure RE-GDA0003298599180000055
The formula in S22 is simplified to obtain
Figure RE-GDA0003298599180000056
S24, when 0 is not more than lambda12D is less than or equal to 12 min=f(λ12) Otherwise, S25 is executed.
S25, when
Figure RE-GDA0003298599180000061
Or
Figure RE-GDA0003298599180000062
Then, P is calculated separately1To l2Distance d of1、P2To l2Distance d of2、Q1To l1Distance d of3And Q2To l2Distance d of4And has dmin={d1,d2,d3,d4}min
S3, judging the mechanical arm and the tunnel based on the projection of the cylindrical envelope box on the detection surfaceWhether the roof wall has collided. First, as shown in fig. 4, a three-axis coordinate system is established based on the situation in the tunnel, and a straight line segment T1T3、T2T4The left and right contour lines and the straight line segment T of the tunnel wall surface3T4Is a ground plane, and the O point is a circular arc line section T1T2Center of a circle of (1), T5Is a circular arc line segment T1T2Point A is a straight line segment T1T2The midpoint of the tunnel contour line can obtain the coordinate values of all points on the tunnel contour line under the tunnel face coordinate system and the arch height H of the arc line segment from the construction drawing, so that the radius R of the arc line segment and the coordinate value of the circle center O can be calculated:
Figure RE-GDA0003298599180000063
O(x5,0,z5-R);
wherein x5,z5Respectively, X, Z axis coordinate values of T5.
The specific method of S3 is S31 to S32.
S31, simplifying the projection of the cylindrical envelope box on the detection surface into a rectangle, and respectively recording the two ends of the axial projection of the cylindrical envelope box as K1And K2In polar coordinates, will K1、K2、T1And T2Is described as
Figure RE-GDA0003298599180000064
Figure RE-GDA0003298599180000065
And
Figure RE-GDA0003298599180000066
and is provided with
Figure RE-GDA0003298599180000067
β2=0。
S32, as shown in part a of FIG. 5, when K1And K2Medium maximum polar angle less than T1And T2The most important ofSmall polar angle or K1And K2Medium minimum polar angle greater than T1And T2At the maximum polar angle of (1), the rectangular projection falls entirely within the sector T1OT2Outside the range, the rectangular projection and the arc line segment do not interfere with each other, and the action part corresponding to the rectangular projection does not collide with the top wall of the tunnel.
When T is shown as part b in FIG. 51And T2Maximum polar angle of between K1And K2Between the minimum and maximum polar angles and T1And T2Has a minimum polar angle of less than K1And K2At the smallest polar angle of (1), K is the intersection of the rectangular projection axis and the fan-shaped edge, if
Figure RE-GDA0003298599180000068
And if not, the rectangular projection interferes with the arc line segment and the action part corresponding to the rectangular projection collides with the top wall of the tunnel.
When T is shown in part c of FIG. 51And T2Has a minimum polar angle between K1And K2Between the minimum and maximum polar angles and T1And T2Has a maximum polar angle greater than K1And K2At the maximum polar angle of (1), K is the intersection of the rectangular projection axis and the fan-shaped edge, if
Figure RE-GDA0003298599180000069
The rectangular projection does not interfere with the arc line segment and the action part corresponding to the rectangular projection does not collide with the top wall of the tunnel, otherwise, the rectangular projection interferes with the arc line segment and the action part corresponding to the rectangular projection collides with the top wall of the tunnel.
When K is shown in part d of FIG. 51And K2The middle maximum polar angle and the minimum polar angle are both between T1And T2In between the minimum polar angle and the maximum polar angle, if
Figure RE-GDA0003298599180000071
Moment of inertiaThe shape projection and the arc line segment do not interfere with each other, and the action part corresponding to the rectangular projection does not collide with the top wall of the tunnel, otherwise, the rectangular projection and the arc line segment interfere with each other, and the action part corresponding to the rectangular projection collides with the top wall of the tunnel.
As shown in FIG. 6, in S3, the length of OK is d1Then calculate d1The method comprises the following steps:
computing
Figure RE-GDA0003298599180000072
The vector dot product formula can be used for obtaining
Figure RE-GDA0003298599180000073
From the trigonometric cosine theorem
Figure RE-GDA0003298599180000074
Whether the mechanical arm collides with the vertical side wall of the tunnel or not can be judged based on the projection of the cylinder enveloping box on the tunnel face and based on the left and right contour lines T of the cylinder enveloping box and the wall surface of the tunnel1T3、T2T4The distance between the two cylindrical envelope boxes is judged, the calculation method of the distance is the same as the calculation method of the minimum distance between the two cylindrical envelope boxes, and when the distance is more than 0, the mechanical arm does not collide with the vertical side wall of the tunnel.
The previous description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the present invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be applied to other embodiments without departing from the spirit or scope of the invention. Thus, the present invention is not intended to be limited to the embodiments shown herein but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.

Claims (6)

1. A mechanical arm collision detection method for a multi-arm rock drilling robot is characterized by comprising the following steps: the method comprises the following steps:
s1, converting a mechanical arm of the rock drilling robot into a set of a plurality of cylindrical enveloping boxes, converting the top wall of the tunnel into an arc line segment and constructing a fan-shaped detection surface based on the arc line segment;
s2, detecting the minimum distance value between any two cylinder enveloping boxes in real time in the action process of the rock drilling robot to judge whether the mechanical arms collide;
and S3, judging whether the mechanical arm collides with the top wall of the tunnel or not based on the projection of the cylindrical envelope box on the detection surface.
2. A method of collision detection of a robot arm for a multi-arm rock drilling robot according to claim 1, characterized by: in the S1, the mechanical arm comprises a working arm and a hanging basket arm, the working arm and the hanging basket arm respectively comprise two or more action parts, and all the action parts are converted into a cylindrical enveloping box;
respectively marking two end points of the arc segment as T1And T2If the center of the arc line is marked as O, the detection surface is sector T1OT2Radius R and pole O, OT2A polar coordinate system is constructed for the polar axis.
3. A method of collision detection of a robot arm for a multi-arm rock drilling robot according to claim 2, characterized by: in S2, if the minimum distance between the axes of the two cylindrical envelope boxes involved in the detection is d, the minimum distance between the two cylindrical envelope boxes is dmin=d-(r1+r2) Wherein r is1And r2Respectively, the radius of two cylinders enveloping the box, if dminIf the number is more than 0, the action parts corresponding to the two cylindrical envelope boxes do not collide, otherwise, the action parts corresponding to the two cylindrical envelope boxes collide.
4. A method of collision detection of a robot arm for a multi-arm rock drilling robot according to claim 3, characterized by: in S2, the method of calculating the minimum distance d between the two cylinder axes is:
s21, recording the axial line segment of the two cylinder envelope boxes as l1And l2,l1Respectively has two end point coordinates of P1(x1,y1,z1) And P2(x2,y2,z2),l2Are respectively Q1(x3,y3,z3) And Q2(x4,y4,z4) Then l is1And l2The coordinates of any point above can be expressed as:
Figure RE-FDA0003298599170000011
wherein the vector
Figure RE-FDA0003298599170000012
(Vector)
Figure RE-FDA0003298599170000013
λ1And λ2Is a coefficient;
s22, converting the solving process of the minimum distance d into a solving coefficient lambda1And λ2The process of the optimal solution of (a) is,
Figure RE-FDA0003298599170000014
s23 minimum-based condition
Figure RE-FDA0003298599170000015
The formula in S22 is simplified to obtain
Figure RE-FDA0003298599170000021
S24, when 0 is not more than lambda12D is less than or equal to 12=f(λ12) Otherwise, executing S25;
s25, when
Figure RE-FDA0003298599170000022
Or
Figure RE-FDA0003298599170000023
Then, P is calculated separately1To l2Distance d of1、P2To l2Distance d of2、Q1To l1Distance d of3And Q2To l2Distance d of4And has d ═ d1,d2,d3,d4}min
5. A method of collision detection of a robot arm for a multi-arm rock drilling robot according to claim 2, characterized by: the specific method of S3 is as follows:
s31, simplifying the projection of the cylindrical envelope box on the detection surface into a rectangle, and respectively recording the two ends of the axial projection of the cylindrical envelope box as K1And K2In polar coordinates, will K1、K2、T1And T2Is described as
Figure RE-FDA0003298599170000024
Figure RE-FDA0003298599170000025
And
Figure RE-FDA0003298599170000026
and is provided with
Figure RE-FDA0003298599170000027
β2=0;
S32, when K1And K2Medium maximum polar angle less than T1And T2Minimum polar angle or K in1And K2Middle minimumPolar angle greater than T1And T2At the maximum polar angle of (1), the rectangular projection falls entirely within the sector T1OT2Outside the range, the rectangular projection and the arc line section have no interference, and the action part corresponding to the rectangular projection does not collide with the top wall of the tunnel;
when T is1And T2Maximum polar angle of between K1And K2Between the minimum and maximum polar angles and T1And T2Has a minimum polar angle of less than K1And K2At the smallest polar angle of (1), K is the intersection of the rectangular projection axis and the fan-shaped edge, if
Figure RE-FDA0003298599170000028
Figure RE-FDA0003298599170000029
The rectangular projection and the arc line segment do not interfere with each other and the action part corresponding to the rectangular projection does not collide with the top wall of the tunnel, otherwise, the rectangular projection and the arc line segment interfere with each other and the action part corresponding to the rectangular projection collides with the top wall of the tunnel;
when T is1And T2Has a minimum polar angle between K1And K2Between the minimum and maximum polar angles and T1And T2Has a maximum polar angle greater than K1And K2At the maximum polar angle of (1), K is the intersection of the rectangular projection axis and the fan-shaped edge, if
Figure RE-FDA00032985991700000210
Figure RE-FDA00032985991700000211
The rectangular projection is not interfered with the arc line segment and the action part corresponding to the rectangular projection is not collided with the top wall of the tunnel, otherwise, the rectangular projection is interfered with the arc line segment and the action part corresponding to the rectangular projection is collided with the top wall of the tunnel;
when K is1And K2The middle maximum polar angle and the minimum polar angle are both between T1And T2In between the minimum polar angle and the maximum polar angle, if
Figure RE-FDA00032985991700000212
And if not, the rectangular projection interferes with the arc line segment and the action part corresponding to the rectangular projection collides with the top wall of the tunnel.
6. A method of collision detection of a robot arm for a multi-arm rock drilling robot according to claim 5, characterized by: in S3, the length of OK is d1Then calculate d1The method comprises the following steps:
computing
Figure RE-FDA0003298599170000031
The vector dot product formula can be used for obtaining
Figure RE-FDA0003298599170000032
From the trigonometric cosine theorem
Figure RE-FDA0003298599170000033
CN202110897171.9A 2021-08-05 2021-08-05 Mechanical arm collision detection method for multi-arm rock drilling robot Withdrawn CN113818816A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110897171.9A CN113818816A (en) 2021-08-05 2021-08-05 Mechanical arm collision detection method for multi-arm rock drilling robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110897171.9A CN113818816A (en) 2021-08-05 2021-08-05 Mechanical arm collision detection method for multi-arm rock drilling robot

Publications (1)

Publication Number Publication Date
CN113818816A true CN113818816A (en) 2021-12-21

Family

ID=78912899

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110897171.9A Withdrawn CN113818816A (en) 2021-08-05 2021-08-05 Mechanical arm collision detection method for multi-arm rock drilling robot

Country Status (1)

Country Link
CN (1) CN113818816A (en)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115272379A (en) * 2022-08-03 2022-11-01 杭州新迪数字工程系统有限公司 Projection-based three-dimensional grid model outline extraction method and system
CN115463845A (en) * 2022-09-02 2022-12-13 赛那德科技有限公司 Identification and grabbing method based on dynamic wrapping

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115272379A (en) * 2022-08-03 2022-11-01 杭州新迪数字工程系统有限公司 Projection-based three-dimensional grid model outline extraction method and system
CN115272379B (en) * 2022-08-03 2023-11-28 上海新迪数字技术有限公司 Projection-based three-dimensional grid model outline extraction method and system
CN115463845A (en) * 2022-09-02 2022-12-13 赛那德科技有限公司 Identification and grabbing method based on dynamic wrapping
CN115463845B (en) * 2022-09-02 2023-10-31 赛那德科技有限公司 Identification grabbing method based on dynamic package

Similar Documents

Publication Publication Date Title
CN113818816A (en) Mechanical arm collision detection method for multi-arm rock drilling robot
CN111360824B (en) Double-arm self-collision detection method and computer-readable storage medium
CN107798330B (en) Weld image feature information extraction method
CN107315410B (en) Automatic obstacle removing method for robot
CN110421556B (en) Track planning method for real-time collision avoidance of redundant double-arm service robot and stable operation method
CN112720493B (en) Double-layer collision detection algorithm for mechanical arm and barrier
CN107089599A (en) The suspender safety anticollision system and method recognized based on container case area contoured three-dimensional
WO2023024317A1 (en) Robot obstacle avoidance method and apparatus, and robot
CN111899302A (en) Point cloud data-based visual detection method, device and system
WO2023103621A1 (en) Ship weld joint feature recognition method
CN114633258B (en) Planning method and related device for movement track of mechanical arm in tunnel environment
WO2022143193A1 (en) Automatic hoisting method for tower crane
CN111203916B (en) Robot joint and geometric body collision detection method
CN111520163B (en) Mixed spraying method of intelligent mixed spraying robot
CN102935979B (en) Control method facing double moving type crane collaborative operation
CN214334089U (en) High overload protection force sensor and robot
CN104528540A (en) Real-time generation method of hoisting scheme of jib crane in vehicle controller and method thereof
CN103278153B (en) A kind of truck-mounted crane three-dimensional path planning method mapped based on space two-dimensional
CN115958593A (en) Intelligent breaking-in robot collision detection method and system based on dual vectors and computer storage medium
CN105241683A (en) Collision detection method for double-series connection mechanical arm type mobile manipulator device
CN113561186A (en) Evaluation method for manipulator path planning result
CN113377066A (en) Rapid interference detection method for NURBS curved surface five-axis machining cutter path
CN111915588A (en) Safe distance calculation method for warehouse construction machinery considering safe and efficient space
CN111137792A (en) Three-dimensional anti-collision method and equipment for tower crane
CN114967454B (en) Tower crane track planning method, system, electronic equipment and storage medium

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
WW01 Invention patent application withdrawn after publication
WW01 Invention patent application withdrawn after publication

Application publication date: 20211221