CN113772363A - Scraper conveyor pose model establishing method and system - Google Patents

Scraper conveyor pose model establishing method and system Download PDF

Info

Publication number
CN113772363A
CN113772363A CN202110963576.8A CN202110963576A CN113772363A CN 113772363 A CN113772363 A CN 113772363A CN 202110963576 A CN202110963576 A CN 202110963576A CN 113772363 A CN113772363 A CN 113772363A
Authority
CN
China
Prior art keywords
section
scraper
middle groove
included angle
scraper conveyor
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
CN202110963576.8A
Other languages
Chinese (zh)
Other versions
CN113772363B (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.)
China University of Mining and Technology CUMT
Original Assignee
China University of Mining and Technology CUMT
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 China University of Mining and Technology CUMT filed Critical China University of Mining and Technology CUMT
Priority to CN202110963576.8A priority Critical patent/CN113772363B/en
Publication of CN113772363A publication Critical patent/CN113772363A/en
Application granted granted Critical
Publication of CN113772363B publication Critical patent/CN113772363B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/22—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes
    • G01B21/24—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring angles or tapers; for testing the alignment of axes for testing alignment of axes
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
    • G06F17/10—Complex mathematical operations
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G2201/00—Indexing codes relating to handling devices, e.g. conveyors, characterised by the type of product or load being conveyed or handled
    • B65G2201/04—Bulk
    • B65G2201/045—Sand, soil and mineral ore

Landscapes

  • Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Mathematical Physics (AREA)
  • Data Mining & Analysis (AREA)
  • Mathematical Analysis (AREA)
  • Mathematical Optimization (AREA)
  • Computational Mathematics (AREA)
  • Pure & Applied Mathematics (AREA)
  • Databases & Information Systems (AREA)
  • Software Systems (AREA)
  • General Engineering & Computer Science (AREA)
  • Algebra (AREA)
  • Control Of Conveyors (AREA)

Abstract

The invention discloses a method and a system for establishing a position and posture model of a scraper conveyor, wherein the method comprises the following steps: establishing a reference coordinate system OXYZ, sequentially connecting the reference coordinate system OXYZ into a plurality of middle grooves, defining the vertex of one side of a gap formed by a first middle groove and a second middle groove as a coordinate origin O, the length direction of the first middle groove as an X axis, the width direction as a Y axis, and the direction vertical to the plane of the middle grooves as a Z axis; defining each parameter of the pose model, and defining the length L and the width H of a middle groove of the scraper conveyor; the central point of the middle groove of the scraper conveyor is taken as a position standard point, and an included angle formed between two adjacent middle grooves of the middle groove of the scraper conveyor in a bending state is defined as alphaiTwo scrapers conveying due to included angleA space is formed on the other side of the middle groove of the machine, and the space is defined as a; the included angle between the middle groove of each scraper conveyor and the horizontal plane is defined as theta in the whole bending statei(ii) a And simplifying and deducing the complex operation condition of the scraper conveyor to form a pose model.

Description

Scraper conveyor pose model establishing method and system
Technical Field
The invention relates to a method and a system for establishing a position and posture model of a scraper conveyor, which are suitable for linearity sensing of the scraper conveyor on a coal mine underground working surface.
Background
The intelligent sensing is one of three essential elements of intelligent mining of coal mines, and is also one of the most basic links. The precision of intelligent perception has an extremely important influence on the realization of intelligent decision and automatic control. The straightness sensing precision of the scraper conveyor is higher, the pushing of the hydraulic support is more accurate, and the coal cutting efficiency of the coal cutter is higher. However, the traditional scraper conveyor pose model is established indirectly through a hydraulic support or a coal mining machine. The position and the posture of the scraper conveyor are calculated by monitoring the pushing action of the hydraulic support, and the position and the posture of the scraper conveyor are inverted after the operation track of the coal mining machine is calculated by an inertial navigation system on the coal mining machine. The two traditional scraper conveyor position and posture models belong to indirect establishment methods, and both can generate larger accumulated errors, so that the straightness accuracy of the scraper conveyor is low, and the intelligent sensing requirement is difficult to meet.
Disclosure of Invention
In order to solve the problems and requirements, the technical scheme provides a scraper conveyor pose model establishing method which can achieve the technical purpose and bring other technical effects due to the adoption of the following technical characteristics.
One purpose of the invention is to provide a scraper conveyor pose model establishing method, which comprises the following steps:
s10: establishing a reference coordinate system OXYZ, sequentially connecting the reference coordinate system OXYZ into a plurality of middle grooves, defining the vertex of one side of a gap formed by the first section of middle groove and the second section of middle groove as a coordinate origin O, wherein the length direction of the first section of middle groove is an X axis, the width direction is a Y axis, and the direction vertical to the plane of the middle groove is a Z axis;
s20: defining each parameter of the pose model, and defining the length L and the width H of a middle groove of the scraper conveyor; taking the central point of the middle groove of the scraper conveyor as a position standard point, and defining each position standard point as (x) under a coordinate system1，y1)…(xn，yn)…(xn+m，yn+m) (ii) a The included angle formed between two adjacent middle grooves of the middle groove of the scraper conveyor in a bending state is defined as alphaiThe other side of the middle groove of the two scraper conveyors has a distance due to the included angle, and the distance is defined as a; the included angle between the middle groove of each scraper conveyor and the horizontal plane is defined as theta in the whole bending statei；
S30: according to the sensing requirement of the scraper conveyor, carrying out simplified analysis on the complex operation condition of the scraper conveyor to deduce and form a lower posture model of the scraper conveyor under the bending working condition;
the derivation of the lower posture model of the scraper conveyor under the bending working condition comprises the following steps:
s301: assuming that only the front two sections of the middle groove of the scraper conveyer are bent, the included angle theta between the middle groove of the second section of the scraper conveyer and the horizontal plane1An included angle alpha formed between the middle grooves of the front two sections of scraper conveyors1Equal, i.e. theta1＝α1At this time, the state of the second section is:
Figure BDA0003223127460000021
Figure BDA0003223127460000022
s302: if the middle groove of the scraper conveyor is bent by n + m +1 sections, the bending accumulation stage is performed before the n +1 sections, and the included angle theta between the middle groove of the n +1 section scraper conveyor and the horizontal planenIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiAccumulating the sum; i.e. thetan＝α1+α2+…+αnAt this time, the state of the (n + 1) th section is:
Figure BDA0003223127460000023
Figure BDA0003223127460000024
s303: belongs to the bending recovery stage after the section n +1, and the included angle theta between the middle groove of the section n +2 scraper conveyer and the horizontal planen+1Is an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle grooves of the n +2 th section and the n +1 th section of scraper conveyern+1A difference of (d); i.e. thetan+1＝α1+α2+…+αn-αn+1(ii) a At this time, the state of section n +2 is:
Figure BDA0003223127460000025
Figure BDA0003223127460000026
s304: after the section n +2, the included angle theta between the middle groove of the section n + m +1 scraper conveyer and the horizontal planen+mIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle groove of the adjacent scraper conveyer from the n +2 th section to the n + m +2 th sectioniDifference of the accumulated sums; i.e. thetan+m＝α1+α2+…+αn-αn+1-αn+2-…-αn+m(ii) a At this time, the state of section n + m +1 is:
Figure BDA0003223127460000027
Figure BDA0003223127460000028
s305: and (3) synthesizing the above formulas to obtain a lower posture model of the scraper conveyor under the bending working condition:
Figure BDA0003223127460000031
Figure BDA0003223127460000032
Figure BDA0003223127460000033
in one embodiment of the present invention, in step S30, the simplified analysis of the complex operating conditions of the scraper conveyor comprises the steps of:
s31: assuming that the first middle groove is in a standard straight state;
s32: assuming the face conveyor is in a flat coal seam floor, there is only a bend parallel to the coal seam floor.
Another objective of the present invention is to provide a scraper conveyor posture model building system, including:
defining a coordinate system module: the system is used for establishing a reference coordinate system OXYZ, and is sequentially connected into a plurality of middle grooves, the vertex of one side of a gap formed by a first section of middle groove and a second section of middle groove is defined as a coordinate origin O, the length direction of the first section of middle groove is an X axis, the width direction is a Y axis, and the direction vertical to the plane of the middle groove is a Z axis;
a parameter defining module: the pose model is used for defining all parameters of the pose model, and the length of a middle groove of the scraper conveyor is defined as L, and the width of the middle groove of the scraper conveyor is defined as H; taking the central point of the middle groove of the scraper conveyor as a position standard point, and defining each position standard point as (x) under a coordinate system1，y1)…(xn，yn)…(xn+m，yn+m) (ii) a The included angle formed between two adjacent middle grooves of the middle groove of the scraper conveyor in a bending state is defined as alphaiThe other side of the middle groove of the two scraper conveyors has a distance due to the included angle, and the distance is defined as a; the included angle between the middle groove of each scraper conveyor and the horizontal plane is defined as theta in the whole bending statei；
A pose model establishing module: according to the sensing requirement of the scraper conveyor, carrying out simplified analysis on the complex operation condition of the scraper conveyor to deduce and form a lower posture model of the scraper conveyor under the bending working condition;
the derivation of the lower posture model of the scraper conveyor under the bending working condition comprises the following steps:
the first calculation unit: the included angle theta between the middle groove of the second section of scraper conveyer and the horizontal plane is used for assuming that only the front two sections of the middle groove of the scraper conveyer are bent1An included angle alpha formed between the middle grooves of the front two sections of scraper conveyors1Equal, i.e. theta1＝α1Calculating (x)1,y1) Position coordinates of (2):
Figure BDA0003223127460000041
Figure BDA0003223127460000042
a second calculation unit: when the middle groove of the scraper conveyor is bent by n + m +1 sections, calculating (x)n,yn) The included angle theta between the middle groove of the scraper conveyer of the (n + 1) th section and the horizontal plane belongs to the bending accumulation stage before the (n + 1) th sectionnIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiAccumulating the sum; i.e. thetan＝α1+α2+…+αnAt this time, the state of the (n + 1) th section is:
Figure BDA0003223127460000043
Figure BDA0003223127460000044
a third calculation unit: for calculating (x) belonging to the bending recovery stage after section n +1n+1,yn+1) The included angle theta between the middle groove of the (n + 2) th section of scraper conveyer and the horizontal planen+1Is an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle grooves of the n +2 th section and the n +1 th section of scraper conveyern+1A difference of (d); i.e. thetan+1＝α1+α2+…+αn-αn+1(ii) a At this time, the state of section n +2 is:
Figure BDA0003223127460000045
Figure BDA0003223127460000046
a fourth calculation unit: for calculating (x) after section n +2n+m,yn+m) The included angle theta between the middle groove of the (n + m + 1) th section of scraper conveyer and the horizontal planen+mIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle groove of the adjacent scraper conveyors from the (n + 2) th section to the (n + m + 1) th sectioniDifference of the accumulated sums; i.e. thetan+m＝α1+α2+…+αn-αn+1-αn+2-…-αn+m(ii) a At this time, the state of section n + m +1 is:
Figure BDA0003223127460000047
Figure BDA0003223127460000048
a fifth calculation unit: the lower attitude model of the scraper conveyor under the bending condition is obtained according to the first calculating unit, the second calculating unit, the third calculating unit and the fourth calculating unit:
Figure BDA0003223127460000051
Figure BDA0003223127460000052
Figure BDA0003223127460000053
in one embodiment of the present invention, the pose model building module further includes:
a first defining unit: the first middle groove is used for defining a first straight state as a reference;
a second positioning unit: for defining scraper conveyors in flat coal seam floors, only curves parallel to the coal seam floor exist.
Compared with the prior art that the position and posture model of the scraper conveyor is indirectly established based on the movement of a hydraulic support or a coal mining machine, the method realizes the direct establishment of the position and posture model of the scraper conveyor by monitoring the angle variation between the middle grooves of two adjacent sections of the scraper conveyor. The pose model establishing method is beneficial to eliminating accumulated errors of indirectly establishing the model, and improves the precision of monitoring the pose of the scraper conveyor.
The following description of the preferred embodiments for carrying out the present invention will be made in detail with reference to the accompanying drawings so that the features and advantages of the present invention can be easily understood.
Drawings
In order to more clearly illustrate the technical solutions of the embodiments of the present invention, the drawings of the embodiments of the present invention will be briefly described below. Wherein the drawings are only for purposes of illustrating some embodiments of the invention and are not to be construed as limiting the invention to all embodiments thereof.
Fig. 1 is a flowchart of a scraper conveyor curved pose model building method according to an embodiment of the present invention;
fig. 2 is a schematic view of a curved pose model of the scraper conveyor according to the embodiment of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the embodiments of the present invention clearer, the technical solutions of the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings of specific embodiments of the present invention. Like reference symbols in the various drawings indicate like elements. It should be noted that the described embodiments are only some embodiments of the invention, and not all embodiments. All other embodiments, which can be derived by a person skilled in the art from the described embodiments of the invention without any inventive step, are within the scope of protection of the invention.
One object of the present invention is to provide a scraper conveyor pose model establishing method, as shown in fig. 1 and fig. 2, including the following steps:
s10: establishing a reference coordinate system OXYZ, sequentially connecting the reference coordinate system OXYZ into a plurality of middle grooves, defining the vertex of one side of a gap formed by the first section of middle groove and the second section of middle groove as a coordinate origin O, wherein the length direction of the first section of middle groove is an X axis, the width direction is a Y axis, and the direction vertical to the plane of the middle groove is a Z axis;
s20: defining each parameter of the pose model, and defining the length L and the width H of a middle groove of the scraper conveyor; taking the central point of the middle groove of the scraper conveyor as a position standard point, and defining each position standard point as (x) under a coordinate system1，y1)…(xn，yn)…(xn+m，yn+m) (ii) a The included angle formed between two adjacent middle grooves of the middle groove of the scraper conveyor in a bending state is defined as alphaiThe other side of the middle groove of the two scraper conveyors has a distance due to the included angle, and the distance is defined as a; the included angle between the middle groove of each scraper conveyor and the horizontal plane is defined as theta in the whole bending statei；
S30: according to the sensing requirement of the scraper conveyor, carrying out simplified analysis on the complex operation condition of the scraper conveyor to deduce and form a lower posture model of the scraper conveyor under the bending working condition;
the derivation of the lower posture model of the scraper conveyor under the bending working condition comprises the following steps:
s301: assuming that only the front two sections of the middle groove of the scraper conveyer are bent, the included angle theta between the middle groove of the first section of the scraper conveyer and the horizontal plane1An included angle alpha formed between the middle grooves of the front two sections of scraper conveyors1Equal, i.e. theta1＝α1At this time, the state of the second section is:
Figure BDA0003223127460000061
Figure BDA0003223127460000062
s302: if the middle groove of the scraper conveyor is bent by n + m +1 sections, the bending accumulation stage is performed before the n +1 sections, and the included angle theta between the middle groove of the n +1 section scraper conveyor and the horizontal planenIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiAccumulating the sum; i.e. thetan＝α1+α2+…+αnAt this time, the state of the (n + 1) th section is:
Figure BDA0003223127460000071
Figure BDA0003223127460000072
s303: belongs to the bending recovery stage after the section n +1, and the included angle theta between the middle groove of the section n +2 scraper conveyer and the horizontal planen+1Is an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle grooves of the n +2 th section and the n +1 th section of scraper conveyern+1A difference of (d); i.e. thetan+1＝α1+α2+…+αn-αn+1(ii) a At this time, the state of section n +2 is:
Figure BDA0003223127460000073
Figure BDA0003223127460000074
s304: after the section n +2, the included angle theta between the middle groove of the section n + m +1 scraper conveyer and the horizontal planen+mIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle groove of the adjacent scraper conveyors from the (n + 2) th section to the (n + m + 1) th sectioniDifference of the accumulated sums; i.e. thetan+m＝α1+α2+…+αn-αn+1-αn+2-…-αn+m(ii) a At this time, the state of section n + m +1 is:
Figure BDA0003223127460000075
Figure BDA0003223127460000076
s305: and (3) synthesizing the above formulas to obtain a lower posture model of the scraper conveyor under the bending working condition:
Figure BDA0003223127460000077
Figure BDA0003223127460000081
Figure BDA0003223127460000082
in one embodiment of the present invention, in step S30, the simplified analysis of the complex operating conditions of the scraper conveyor comprises the steps of:
s31: assuming that the first middle groove is in a standard straight state;
s32: assuming the face conveyor is in a flat topographical environment, there is only a horizontal bend.
Compared with the prior art that the position and posture model of the scraper conveyor is indirectly established based on the movement of a hydraulic support or a coal mining machine, the method realizes the direct establishment of the position and posture model of the scraper conveyor by monitoring the angle variation between the middle grooves of two adjacent sections of the scraper conveyor. The pose model establishing method is beneficial to eliminating accumulated errors of indirectly establishing the model, and improves the precision of monitoring the pose of the scraper conveyor.
Another objective of the present invention is to provide a scraper conveyor posture model building system, including:
defining a coordinate system module: the system is used for establishing a reference coordinate system OXYZ, and is sequentially connected into a plurality of middle grooves, the vertex of one side of a gap formed by a first section of middle groove and a second section of middle groove is defined as a coordinate origin O, the length direction of the first section of middle groove is an X axis, the width direction is a Y axis, and the direction vertical to the plane of the middle groove is a Z axis;
a parameter defining module: the pose model is used for defining all parameters of the pose model, and the length of a middle groove of the scraper conveyor is defined as L, and the width of the middle groove of the scraper conveyor is defined as H; taking the central point of the middle groove of the scraper conveyor as a position standard point, and defining each position standard point as (x) under a coordinate system1，y1)…(xn，yn)…(xn+m，yn+m) (ii) a The included angle formed between two adjacent middle grooves of the middle groove of the scraper conveyor in a bending state is defined as alphaiThe other side of the middle groove of the two scraper conveyors has a distance due to the included angle, and the distance is defined as a; the included angle between the middle groove of each scraper conveyor and the horizontal plane is defined as theta in the whole bending statei；
A pose model establishing module: according to the sensing requirement of the scraper conveyor, carrying out simplified analysis on the complex operation condition of the scraper conveyor to deduce and form a lower posture model of the scraper conveyor under the bending working condition;
the derivation of the lower posture model of the scraper conveyor under the bending working condition comprises the following steps:
the first calculation unit: the included angle theta between the middle groove of the second section of scraper conveyer and the horizontal plane is used for assuming that only the front two sections of the middle groove of the scraper conveyer are bent1An included angle alpha formed between the middle grooves of the front two sections of scraper conveyors1Equal, i.e. theta1＝α1Calculating (x)1,y1) Position coordinates of (2):
Figure BDA0003223127460000091
Figure BDA0003223127460000092
a second calculation unit: when the middle groove of the scraper conveyor is bent by n + m +1 sections, calculating (x)n,yn) The included angle theta between the middle groove of the scraper conveyer of the (n + 1) th section and the horizontal plane belongs to the bending accumulation stage before the (n + 1) th sectionnIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiCumulative sum, i.e. thetan＝α1+α2+…+αnAt this time, the state of the (n + 1) th section is:
Figure BDA0003223127460000093
Figure BDA0003223127460000094
a third calculation unit: for calculating (x) belonging to the bending recovery stage after section n +1n+1,yn+1) The included angle theta between the middle groove of the (n + 2) th section of scraper conveyer and the horizontal planen+1In the front n +1 adjacent scraper conveyorsThe angle alpha formed between the partial groovesiThe included angle alpha formed between the accumulated sum and the middle grooves of the n +2 th section and the n +1 th section of scraper conveyern+1A difference of (d); i.e. thetan+1＝α1+α2+…+αn-αn+1(ii) a At this time, the state of section n +2 is:
Figure BDA0003223127460000095
Figure BDA0003223127460000096
a fourth calculation unit: for calculating (x) after section n +2n+m,yn+m) The included angle theta between the middle groove of the (n + m + 1) th section of scraper conveyer and the horizontal planen+mIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle groove of the adjacent scraper conveyors from the (n + 2) th section to the (n + m + 1) th sectioniDifference of the accumulated sums; i.e. thetan+m＝α1+α2+…+αn-αn+1-αn+2-…-αn+m(ii) a At this time, the state of section n + m +1 is:
Figure BDA0003223127460000097
Figure BDA0003223127460000098
a fifth calculation unit: the lower attitude model of the scraper conveyor under the bending condition is obtained according to the first calculating unit, the second calculating unit, the third calculating unit and the fourth calculating unit:
Figure BDA0003223127460000101
Figure BDA0003223127460000102
Figure BDA0003223127460000103
in one embodiment of the present invention, the pose model building module further includes:
a first defining unit: the first middle groove is used for defining a first straight state as a reference;
a second positioning unit: for defining scraper conveyors in flat coal seam floors, only curves parallel to the coal seam floor exist.
Compared with the prior art that the position and posture model of the scraper conveyor is indirectly established based on the movement of a hydraulic support or a coal mining machine, the system realizes the direct establishment of the position and posture model of the scraper conveyor by monitoring the angle variation between the middle grooves of two adjacent sections of the scraper conveyor, and the position and posture model establishment system is favorable for eliminating the accumulated error of the indirectly established model and improving the accuracy of the position and posture monitoring of the scraper conveyor.
Although the exemplary embodiment of the scraper conveyor posture model building method proposed by the present invention has been described in detail with reference to the preferred embodiments, it will be understood by those skilled in the art that various changes and modifications can be made to the above specific embodiments without departing from the concept of the present invention, and various combinations of the technical features and structures proposed by the present invention can be made without departing from the scope of the present invention as defined by the appended claims.

Claims (4)

1. A scraper conveyor pose model establishing method is characterized by comprising the following steps:
s10: establishing a reference coordinate system OXYZ, sequentially connecting the reference coordinate system OXYZ into a plurality of middle grooves, defining the vertex of one side of a gap formed by the first section of middle groove and the second section of middle groove as a coordinate origin O, wherein the length direction of the first section of middle groove is an X axis, the width direction is a Y axis, and the direction vertical to the plane of the middle groove is a Z axis;
s20: defining each parameter of the pose model, and defining the length L and the width H of a middle groove of the scraper conveyor; taking the central point of the middle groove of the scraper conveyor as a position standard point, and defining each position standard point as (x) under a coordinate system1，y1)···(xn，yn)···(xn+m，yn+m) (ii) a The included angle formed between two adjacent middle grooves of the middle groove of the scraper conveyor in a bending state is defined as alphaiThe other side of the middle groove of the two scraper conveyors has a distance due to the included angle, and the distance is defined as a; the included angle between the middle groove of each scraper conveyor and the horizontal plane is defined as theta in the whole bending statei；
S30: according to the sensing requirement of the scraper conveyor, carrying out simplified analysis on the complex operation condition of the scraper conveyor to deduce and form a lower posture model of the scraper conveyor under the bending working condition;
the derivation of the lower posture model of the scraper conveyor under the bending working condition comprises the following steps:
s301: assuming that only the front two sections of the middle groove of the scraper conveyer are bent, the included angle theta between the middle groove of the second section of the scraper conveyer and the horizontal plane1An included angle alpha formed between the middle grooves of the front two sections of scraper conveyors1Equal, i.e. theta1＝α1At this time, the state of the second section is:
Figure FDA0003223127450000011
Figure FDA0003223127450000012
s302: if the middle groove of the scraper conveyor is bent by n + m +1 sections, the bending accumulation stage is performed before the n +1 sections, and the included angle theta between the middle groove of the n +1 section scraper conveyor and the horizontal planenIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiSum of accumulations(ii) a I.e. thetan＝α1+α2+…+αnAt this time, the state of the (n + 1) th section is:
Figure FDA0003223127450000013
Figure FDA0003223127450000014
s303: belongs to the bending recovery stage after the section n +1, and the included angle theta between the middle groove of the section n +2 scraper conveyer and the horizontal planen+1Is an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle grooves of the n +2 th section and the n +1 th section of scraper conveyern+1A difference of (d); i.e. thetan+1＝α1+α2+…+αn-αn+1(ii) a At this time, the state of section n +2 is:
Figure FDA0003223127450000021
Figure FDA0003223127450000022
s304: after the section n +2, the included angle theta between the middle groove of the section n + m +1 scraper conveyer and the horizontal planen+mIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle groove of the adjacent scraper conveyors from the (n + 2) th section to the (n + m + 1) th sectioniDifference of the accumulated sums; i.e. thetan+m＝α1+α2+…+αn-αn+1-αn+2-…-αn+m(ii) a At this time, the state of section n + m +1 is:
Figure FDA0003223127450000023
Figure FDA0003223127450000024
s305: and (3) synthesizing the above formulas to obtain a lower posture model of the scraper conveyor under the bending working condition:
Figure FDA0003223127450000025
Figure FDA0003223127450000026
Figure FDA0003223127450000027
2. the scraper conveyor posture model building method according to claim 1,
in step S30, the simplified analysis of the complex operating conditions of the scraper conveyor includes the steps of:
s31: assuming that the middle groove of the first section is in a standard straight state;
s32: assuming the face conveyor is in a flat coal seam floor, there is only a bend parallel to the coal seam floor.
3. A scraper conveyor position and posture model establishing system is characterized by comprising:
defining a coordinate system module: the system is used for establishing a reference coordinate system OXYZ, and is sequentially connected into a plurality of middle grooves, the vertex of one side of a gap formed by a first section of middle groove and a second section of middle groove is defined as a coordinate origin O, the length direction of the first section of middle groove is an X axis, the width direction is a Y axis, and the direction vertical to the plane of the middle groove is a Z axis;
a parameter defining module: the pose model is used for defining all parameters of the pose model, and the length of a middle groove of the scraper conveyor is defined as L, and the width of the middle groove of the scraper conveyor is defined as H; taking the central point of the middle groove of the scraper conveyor as a position standard point, and defining each position standard point as (x) under a coordinate system1，y1)···(xn，yn)···(xn+m，yn+m) (ii) a The included angle formed between two adjacent middle grooves of the middle groove of the scraper conveyor in a bending state is defined as alphaiThe other side of the middle groove of the two scraper conveyors has a distance due to the included angle, and the distance is defined as a; the included angle between the middle groove of each scraper conveyor and the horizontal plane is defined as theta in the whole bending statei；
A pose model establishing module: according to the sensing requirement of the scraper conveyor, carrying out simplified analysis on the complex operation condition of the scraper conveyor to deduce and form a lower posture model of the scraper conveyor under the bending working condition;
the derivation of the lower posture model of the scraper conveyor under the bending working condition comprises the following steps:
the first calculation unit: the included angle theta between the middle groove of the second section of scraper conveyer and the horizontal plane is used for assuming that only the front two sections of the middle groove of the scraper conveyer are bent1An included angle alpha formed between the middle grooves of the front two sections of scraper conveyors1Equal, i.e. theta1＝α1Calculating (x)1,y1) Position coordinates of (2):
Figure FDA0003223127450000031
Figure FDA0003223127450000032
a second calculation unit: when the middle groove of the scraper conveyor is bent by n + m +1 sections, calculating (x)n,yn) The included angle theta between the middle groove of the scraper conveyer of the (n + 1) th section and the horizontal plane belongs to the bending accumulation stage before the (n + 1) th sectionnScraping the front n +1 sections adjacentlyThe angle alpha formed between the middle grooves of the plate conveyeriCumulative sum, i.e. thetan＝α1+α2+…+αnAt this time, the state of the (n + 1) th section is:
Figure FDA0003223127450000033
Figure FDA0003223127450000034
a third calculation unit: for calculating (x) belonging to the bending recovery stage after section n +1n+1,yn+1) The included angle theta between the middle groove of the (n + 2) th section of scraper conveyer and the horizontal planen+1Is an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle grooves of the n +2 th section and the n +1 th section of scraper conveyern+1A difference of (d); i.e. thetan+1＝α1+α2+…+αn-αn+1(ii) a At this time, the state of section n +2 is:
Figure FDA0003223127450000041
Figure FDA0003223127450000042
a fourth calculation unit: for calculating (x) after section n +2n+m,yn+m) The included angle theta between the middle groove of the (n + m + 1) th section of scraper conveyer and the horizontal planen+mIs an included angle alpha formed between middle grooves of adjacent front n +1 sections of scraper conveyorsiThe included angle alpha formed between the accumulated sum and the middle groove of the adjacent scraper conveyors from the (n + 2) th section to the (n + m + 1) th sectioniDifference of cumulative sum, i.e. thetan+m＝α1+α2+…+αn-αn+1-αn+2-…-αn+m(ii) a At this time, the state of section n + m +1 is:
Figure FDA0003223127450000043
Figure FDA0003223127450000044
a fifth calculation unit: the lower attitude model of the scraper conveyor under the bending condition is obtained according to the first calculating unit, the second calculating unit, the third calculating unit and the fourth calculating unit:
Figure FDA0003223127450000045
Figure FDA0003223127450000046
Figure FDA0003223127450000047
4. the scraper conveyor posture model building system according to claim 3,
the pose model building module further comprises:
a first defining unit: used for defining the first section middle groove as a standard straight state;
a second defining unit: for defining scraper conveyors in flat coal seam floors, only curves parallel to the coal seam floor exist.
CN202110963576.8A 2021-08-20 2021-08-20 Scraper conveyor pose model establishing method and system Active CN113772363B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110963576.8A CN113772363B (en) 2021-08-20 2021-08-20 Scraper conveyor pose model establishing method and system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110963576.8A CN113772363B (en) 2021-08-20 2021-08-20 Scraper conveyor pose model establishing method and system

Publications (2)

Publication Number Publication Date
CN113772363A true CN113772363A (en) 2021-12-10
CN113772363B CN113772363B (en) 2022-05-20

Family

ID=78838519

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110963576.8A Active CN113772363B (en) 2021-08-20 2021-08-20 Scraper conveyor pose model establishing method and system

Country Status (1)

Country Link
CN (1) CN113772363B (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115571582A (en) * 2022-10-10 2023-01-06 山东科技大学 Method for detecting middle groove track of scraper conveyor

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106595557A (en) * 2016-10-31 2017-04-26 中国矿业大学 Detection device for straightness of scraper conveyer and detection method
CN107685989A (en) * 2017-09-06 2018-02-13 中煤张家口煤矿机械有限责任公司 A kind of drag conveyor attitude intelligent sensing device and method
CN109018851A (en) * 2018-08-13 2018-12-18 太原理工大学 The method of real-time of drag conveyor three-dimensional space operation posture position
CN111125845A (en) * 2020-02-28 2020-05-08 赵晓巍 Space straightness error evaluation method based on centroid link method
CN111811427A (en) * 2020-06-30 2020-10-23 中国矿业大学 Method for monitoring straightness of scraper conveyor
JP2021011364A (en) * 2019-07-08 2021-02-04 株式会社サタケ Monitoring device of scraper conveyor

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106595557A (en) * 2016-10-31 2017-04-26 中国矿业大学 Detection device for straightness of scraper conveyer and detection method
CN107685989A (en) * 2017-09-06 2018-02-13 中煤张家口煤矿机械有限责任公司 A kind of drag conveyor attitude intelligent sensing device and method
CN109018851A (en) * 2018-08-13 2018-12-18 太原理工大学 The method of real-time of drag conveyor three-dimensional space operation posture position
JP2021011364A (en) * 2019-07-08 2021-02-04 株式会社サタケ Monitoring device of scraper conveyor
CN111125845A (en) * 2020-02-28 2020-05-08 赵晓巍 Space straightness error evaluation method based on centroid link method
CN111811427A (en) * 2020-06-30 2020-10-23 中国矿业大学 Method for monitoring straightness of scraper conveyor

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115571582A (en) * 2022-10-10 2023-01-06 山东科技大学 Method for detecting middle groove track of scraper conveyor
CN115571582B (en) * 2022-10-10 2023-08-29 山东科技大学 Method for detecting track of middle groove of scraper conveyor

Also Published As

Publication number Publication date
CN113772363B (en) 2022-05-20

Similar Documents

Publication Publication Date Title
CN109018851B (en) Real-time monitoring method for three-dimensional space operation attitude position of scraper conveyor
CN110703266A (en) Accurate positioning and navigation system of heading machine
CN111750822B (en) Coal mining induced overlying strata and surface subsidence collaborative dynamic prediction method
CN112001982B (en) Coal mining machine intelligent cutting method and system based on CT (computed tomography) sectioning of coal seam digital model
CN111927518B (en) Automatic straightening method for fully mechanized coal mining face hydraulic support based on combination of inertial navigation and odometer
CN103148804A (en) Indoor unknown structure identification method based on laser scanning
CN102915558A (en) Method for quickly extracting building three-dimensional outline information in onboard LiDAR (light detection and ranging) data
CN113772363B (en) Scraper conveyor pose model establishing method and system
CN105547166A (en) 2D laser scanning based rapid detection method for heading window of heading machine
CN104390648B (en) A kind of Mine Disaster Relief Robot paths planning method based on Artificial Potential Field
CN107270901A (en) Merge the coal-winning machine accuracy of inertial position method for improving of coal winning technology and coal-winning machine motion model
CN111612902B (en) Method for constructing coal mine roadway three-dimensional model based on radar point cloud data
CN110658528A (en) Laser radar-based fully mechanized coal mining face complete equipment offset monitoring method
CN109115172B (en) Machine vision-based method for detecting pose of body of coal mining machine
CN102393211B (en) Performance testing method of section monitoring system of cantilever excavator
CN108827220B (en) Coal mine fully-mechanized coal mining face straightness detection method based on strapdown inertial navigation
CN105954760A (en) Automatic alignment method for tunnel heading machine
CN111080787B (en) Mathematical geology-based fold structure recovery method
CN108020196A (en) A kind of subway tunnel 3 d deformation monitoring method based on baseline
CN111414442A (en) Navigation mark position checking method based on navigation channel topographic map and water level data
CN113944494B (en) Hydraulic support automatic alignment method and system based on ultrasonic wireless ranging
CN110599595A (en) Three-dimensional characterization method for geological structure
WO2023019808A1 (en) Method and system for measuring upward and downward displacement of fully mechanized mining face device
CN114412459B (en) Less-sensing non-teaching automatic cutting method for intelligent fully mechanized coal mining face coal mining machine
CN103322976B (en) Monitoring system for flowing deformation of coal mine tunnel floor rock stratum and method thereof

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
CB03 Change of inventor or designer information

Inventor after: Liang Minfu

Inventor after: Fang Xinqiu

Inventor after: Xu Ziyue

Inventor after: Song Yang

Inventor after: Wu Gang

Inventor before: Fang Xinqiu

Inventor before: Xu Ziyue

Inventor before: Song Yang

Inventor before: Liang Minfu

Inventor before: Wu Gang

CB03 Change of inventor or designer information
GR01 Patent grant
GR01 Patent grant