WO2023142631A1 - Straightening method for multi-node device and corresponding device - Google Patents

Straightening method for multi-node device and corresponding device Download PDF

Info

Publication number
WO2023142631A1
WO2023142631A1 PCT/CN2022/133608 CN2022133608W WO2023142631A1 WO 2023142631 A1 WO2023142631 A1 WO 2023142631A1 CN 2022133608 W CN2022133608 W CN 2022133608W WO 2023142631 A1 WO2023142631 A1 WO 2023142631A1
Authority
WO
WIPO (PCT)
Prior art keywords
brackets
bracket
information
cosine
target node
Prior art date
Application number
PCT/CN2022/133608
Other languages
French (fr)
Chinese (zh)
Inventor
陈冬阳
徐景辉
赵彦明
唐世豪
常志武
Original Assignee
华为技术有限公司
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 华为技术有限公司 filed Critical 华为技术有限公司
Publication of WO2023142631A1 publication Critical patent/WO2023142631A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Definitions

  • the present application relates to the field of computer technology, in particular to a method for straightening multi-node equipment and corresponding equipment.
  • the three coal-cutting machines in the fully mechanized mining face of the coal mine refer to the coal shearer, the hydraulic support and the scraper machine, and the scraper machine is also called the scraper conveyor.
  • Hundreds or hundreds of hydraulic supports are arranged according to requirements, and are respectively connected with the scraper machine to form the walking track of the coal mining machine.
  • the shearer moves along the track, while the drum of the shearer cuts coal.
  • the three machines in the fully mechanized mining face have strict requirements of "three straights and one leveling".
  • the three straights mainly refer to the straightness of the array of hydraulic supports, the straightness of the scraper machine, and the straightness of the coal face cut by the shearer.
  • the present application provides a method for straightening multi-node equipment, which is used for automatically straightening support arrays and/or scrapers in a fully mechanized mining face system.
  • Embodiments of the present application also provide corresponding devices, devices, computer-readable storage media, and computer program products.
  • the first aspect of the present application provides a method for straightening multi-node equipment.
  • the method is applied to a fully mechanized mining face system.
  • the fully mechanized mining face system includes a bracket array, a scraper machine and control equipment.
  • the bracket array includes A brackets, where A Each bracket in the brackets is connected to the scraper machine through a push rod, and A is an integer greater than 1.
  • a multi-node device refers to a plurality of devices that work together, or a device has multiple nodes, and the multiple nodes work together.
  • Multi-node devices can be rack arrays or scrapers.
  • the support array includes multiple supports, and the fully mechanized mining face system usually includes dozens or hundreds of supports, and each support can be understood as a node.
  • a scraper is usually a track connected to multiple node devices, and the part connected to a bracket can be understood as a node.
  • the support may be a hydraulic support, a pneumatic support or an electric support.
  • the supports in the fully mechanized mining face system are usually hydraulic supports.
  • control equipment can be computer equipment
  • control equipment in the fully mechanized mining face system refers to the equipment that controls the work of the three coal cutting machines in the fully mechanized mining face.
  • straightening may mean adjusting to a straight line, or not adjusting to an absolute straight line, and the allowable range of error can be understood as straightening.
  • the distribution of the B brackets on the A brackets at intervals refers to obtaining the position information and attitude angle information of a bracket at intervals of several brackets. It should be noted that the interval may be a uniform interval, for example, acquiring position information and attitude angle information of a support every M supports or every (M ⁇ 1) supports.
  • the interval can also be uneven intervals, for example: for the supports in the support array, some obtain the position information and attitude angle information of a support at intervals of (M-1) supports, and some obtain the position information and attitude of a support at intervals of P supports For the angle information, it is also possible to obtain the position information and attitude angle information of a bracket at intervals of Q brackets, and the specific interval method is not limited in this application.
  • the position includes information of one or more translational degrees of freedom among the three translational degrees of freedom.
  • the three translational degrees of freedom include x-axis translation, y-axis translation, and z-axis translation.
  • translation on one or two axes can also be included, such as: x-axis translation, x-axis translation And y-axis translation, in fact, the translation of one axis or two axes can also be understood as a special three-axis translation, except that the translation amount on the other two axes or one axis is 0.
  • the pose includes information on one or more of the three rotational degrees of freedom.
  • the three rotational degrees of freedom include x-axis rotation, y-axis rotation, and z-axis rotation. Of course, it can also include rotation on one or two axes, such as: x-axis rotation, x-axis rotation And y-axis rotation, in fact, the rotation of one axis or two axes can also be understood as a special three-axis rotation, except that the rotation amount on the other two axes or one axis is 0.
  • the information of the translation degree of freedom can be the coordinate information describing an object in the coordinate axis, for example: the position information of each support can be the coordinate of each support on at least one of the x-axis, y-axis and z-axis information.
  • the information of the degree of freedom of rotation can describe the rotation angle of an object around the coordinate axis, such as: heading angle, roll angle or pitch angle, for example, the attitude angle information of each support can include the heading angle information of each support, roll angle At least one of angle information and pitch angle information.
  • the attitude angle information of each support may include heading angle information, roll angle information and pitch angle information of each support.
  • straightening direction refers to the adjustment direction of each bracket in the B brackets and the scraper machine.
  • the straightening direction can be the y-axis direction or any other direction.
  • the straightening direction is not limited.
  • each of the B brackets will have a corresponding first target value.
  • the control device will combine the first target value and the attitude angle of the bracket Information to determine the first adjustment amount, so as to control each of the B brackets to move the bracket to a position corresponding to the first target value, and then straighten the bracket array.
  • the target node is the node connected to the push rod of the bracket on the scraper machine.
  • the attitude angle information of the push rod is the same as that of the bracket.
  • the length value of the push rod indicates the distance from the bracket to the target node. distance.
  • each target node will have a corresponding second target value.
  • the control device will combine the second target value and the attitude angle information of the bracket to determine the second adjustment. Amount, so as to control the push rod of each bracket in the B brackets to move the corresponding target node on the scraper machine, and then straighten the scraper machine.
  • both the first target value and the second target value are numerical values
  • the first target value represents the straightening target of the bracket in the straightening direction
  • the second target value represents the adjustment of the target node of the scraper machine in the straightening direction Straight target.
  • the automatic straightening of the bracket array and/or the scraper machine can be achieved through the control equipment, and the automation of straightening the bracket array and/or the scraper machine is realized.
  • the straightening of the bracket array and the The attitude angle information of the support is also fully considered during the /or scraper machine, which improves the alignment accuracy of the bracket array and/or the scraper machine.
  • each of the B brackets is provided with an inertial measurement unit (inertial measurement unit, IMU) and a stroke sensor, and the stroke sensor is arranged on the drive mechanism of the push rod;
  • IMU inertial measurement unit
  • the stroke sensor is arranged on the drive mechanism of the push rod;
  • the IMU It is used to measure the angular velocity information and acceleration information of the bracket, and the angular velocity information and acceleration information are used to control the equipment to determine the attitude angle information and position information of the bracket;
  • Pushing displacement information combined with attitude angle information and position information is used for control equipment to determine the coordinate information of the target node on the scraper machine.
  • the IMU can be used to measure the angular velocity information and acceleration information of the support, so that the control device can determine the attitude angle information and position information of the support according to the angular velocity information and acceleration information of the support, and the travel sensor can measure The frame displacement information and push displacement information of the support, so that the control device can determine the coordinate information of the target node on the scraper machine in combination with the frame displacement information, push displacement information, attitude angle information and position information.
  • each of the B brackets is provided with an inertial measurement unit (IMU) and a travel sensor. When B is not equal to A, other brackets may also be provided with an IMU or/and a travel sensor.
  • the control device is based on the position information and attitude angle information of each bracket in the B brackets, and the first position corresponding to each bracket in the B brackets in the straightening direction.
  • the target value is used to determine the first adjustment amount of each of the B brackets, including: the control device determines the position information of each of the B brackets in the straightening direction, and the position information of each of the B brackets in the straightening direction The first difference of the corresponding first target value; the control device determines the first difference between the first difference of each of the B brackets and the cosine data of each of the B brackets in the straightening direction as the first adjustment amount; wherein, the cosine data includes the first cosine, or the product of the first cosine and at least one of the second cosine and the third cosine, and the first cosine is the straightening direction of each bracket in the B brackets The cosine of the heading angle, the second cosine is the cosine of the
  • the first difference is the difference between the first target value and the coordinate value of the bracket in the straightening direction, and the difference can be a positive or negative value, and a positive value means that it is the same as the straightening direction, Negative values indicate the opposite direction of straightening.
  • the coordinates of a bracket are (Xn, Yn, Zn)
  • the first adjustment value (Fn-Yn)/cosine data
  • the first cosine cos ⁇ ny
  • the second cosine cos ⁇ nz
  • the third cosine cos ⁇ nx
  • the cosine data can be cos ⁇ ny or cos ⁇ ny.cos ⁇ nz, cos ⁇ ny. cos ⁇ nx or cos ⁇ ny.cos ⁇ nz.cos ⁇ nx.
  • ".” represents the multiplication sign.
  • the method further includes: the control device determines a first curve according to the position information of each of the B brackets, and the first curve is used to describe the position distribution of the B brackets; If the maximum peak value or the maximum valley value in the straightening direction in the first curve exceeds the first threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the second threshold, the control device performs a determination of the first adjustment Quantitative steps.
  • the first curve may be a line connecting the coordinates of each of the B brackets, or may be a curve obtained by fitting the coordinates of each of the B brackets.
  • the first curve may describe the position distribution of the B brackets.
  • the first threshold and the second threshold may be preconfigured values, such as: 1 cm to 50 cm, or other values, if the maximum peak value or the maximum valley value in the straightening direction in the first curve does not exceed the first threshold value, or The difference between the maximum peak value and the maximum valley value in the straightening direction does not exceed the second threshold, which means that the current support array is relatively straight, and no straightening processing is required, which saves time for straightening and improves work efficiency.
  • the control device determines the second adjustment amount of each target node includes: the control device is based on the position information of each bracket in the B brackets, and the position information of each bracket in the B brackets The extended length value of the push rod of the B brackets, and the attitude angle information of each bracket in the B brackets, determine the coordinate information of each target node; the control device determines the coordinate information of each target node in the straightening direction, and The second difference of the second target value corresponding to each target node in the straightening direction; the control device calculates the quotient of the second difference corresponding to each target node and the cosine data of each target node in the straightening direction Determined as the second adjustment amount; wherein, the cosine data includes the fourth
  • the second adjustment amount (En-bn)/cosine data
  • the fourth cosine cos ⁇ ny
  • the fifth cosine cos ⁇ nz
  • the sixth cosine cos ⁇ nx
  • the cosine data can be cos ⁇ ny, or cos ⁇ ny.cos ⁇ nz, cos ⁇ ny. cos ⁇ nx or cos ⁇ ny.cos ⁇ nz.cos ⁇ nx.
  • the present application takes into account various angle factors that may be affected by the push rod when calculating the second adjustment amount, so that the calculated second adjustment amount is more accurate, and further improves the straightening accuracy of the scraper machine.
  • the method further includes: the control device determines a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node; if the first In the second curve, the maximum peak value or the maximum valley value in the straightening direction exceeds the third threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the fourth threshold, then the control device performs determination of the second adjustment amount A step of.
  • the second curve may be a line connecting the coordinates of each target node in the straightening direction, or may be a curve obtained by fitting the coordinates of each target node in the straightening direction.
  • the second curve may describe the position distribution of each target node.
  • the third threshold and the fourth threshold can be pre-configured values, such as: 1 cm to 50 cm, or other values, if the maximum peak or maximum valley value in the second curve does not exceed the third threshold, or in the straightening direction The difference between the maximum peak value and the maximum valley value does not exceed the fourth threshold, which means that the current scraper is relatively straight and does not need to be straightened, which can save time for straightening and improve the working efficiency of the shearer .
  • the method further includes: the control device according to the measured value of the heading angle of each bracket in the straightening direction in the B brackets, and the target value of the heading angle in the straightening direction , to determine the compensation value of the heading angle of each bracket in the B brackets; the control device sends the compensation value of the corresponding heading angle to the adjacent brackets of each bracket in the B brackets, and the compensation value of the heading angle is used for the adjacent brackets to adjust B The position of each bracket in the B brackets, so as to adjust each bracket in the B brackets to the target value of the heading angle.
  • two adjacent brackets in the bracket array can push the other bracket to rotate by a certain angle through the driving mechanisms on both sides.
  • the straightening direction is the y-axis direction
  • the x-axis direction can The push rod of the stent is used to push the adjacent stent to rotate, so as to adjust the angular rotation of the stent in the stent array.
  • the compensation value of the heading angle in this possible implementation includes the compensation value of the angle and the displacement compensation value of the push rod that pushes the adjacent support. If the direction parallel to the coal surface is the x-axis, push the adjacent
  • the push rod of the bracket usually refers to the push rod in the x-axis direction.
  • the compensation value of the angle can be the difference between the target value of the heading angle and the measured value of the heading angle
  • the pushing compensation value of the push rod can be determined according to the length of the bottom plate of the bracket in the Y-axis direction and the compensation value of the angle. The distance that the bracket needs to move in the x-axis direction.
  • the second aspect of the application provides a support in the fully mechanized mining face system, the support is provided with an inertial measurement unit IMU and a travel sensor, the travel sensor is arranged on the drive mechanism of the push rod of the support; the IMU is used to measure the angular velocity information of the support And acceleration information, angular velocity information and acceleration information are used to control the equipment to determine the attitude angle information and position information of the bracket; the stroke sensor is used to measure the frame displacement information and push displacement information of the bracket, and the frame displacement information and push displacement information are combined with the attitude angle
  • the information and position information are used for the control equipment in the fully mechanized mining face system to determine the coordinate information of the target node on the scraper machine in the fully mechanized mining face system.
  • the target node is the connection point between the push rod of the support and the scraper machine.
  • the angular velocity information and acceleration information of the support can be measured through the IMU, so that the control device can determine the attitude angle information and position information of the support according to the angular velocity information and acceleration information of the support, and the travel sensor can measure the frame of the support Displacement information and push displacement information, so that the control device can determine the coordinate information of the target node on the scraper machine by combining the frame displacement information, push displacement information, attitude angle information and position information.
  • the control device can adjust the bracket array and the scraper machine according to the attitude angle information and position information of the bracket, and the coordinate information of the target node on the scraper machine.
  • the fully mechanized mining face system includes a support array, and the support is one of the support arrays; the attitude angle information and position information of the support are used for the control equipment to determine the first target value of the support in conjunction with The first adjustment amount of the bracket, the first adjustment amount is used to move the bracket to straighten the bracket array; the coordinate information of the target node is used to control the device combined with the second target value of the target node to determine the second adjustment amount of the target node , the second adjustment amount is used to push the push rod connected to the target node to straighten the scraper.
  • the support is a hydraulic support, a pneumatic support or an electric support.
  • the IMU is disposed on a base or a top beam of the bracket.
  • the direction of one axis of the IMU is the same as the orientation of the stroke sensor. If the orientation of the stroke sensor is the same as the y-axis direction of the IMU, of course, the stroke sensor can also have an angle with the y-axis. If there is an angle, when calculating the coordinates of the target node, it needs to be considered that the stroke sensor can also be in the same direction as the y-axis. There is an angle between the axes.
  • the third aspect of the present application provides a control device for straightening multi-node equipment.
  • the control device is included in the fully mechanized mining face system.
  • the fully mechanized mining face system also includes a bracket array and a scraper machine.
  • the bracket array includes A brackets, wherein , each of the A brackets is connected to the scraper machine through a push rod, A is an integer greater than 1, and the control equipment includes:
  • the processing unit is used to determine the position information and attitude angle information of each bracket in the B brackets obtained by the acquisition unit, and the first target value corresponding to each bracket in the B brackets in the straightening direction, and determine the position information of each bracket in the B brackets.
  • the second target value corresponding to the target nodes determines the second adjustment value of each target node, and the target node is the connection point between the push rod of each bracket in the B brackets and the scraper machine.
  • the sending unit is configured to send the first adjustment amount and/or the second adjustment amount determined by the corresponding processing unit to each of the B brackets, and the first adjustment amount is used for each bracket of the B brackets to perform adjustment in the straightening direction.
  • the pull frame moves to straighten the bracket array, and the second adjustment amount is used to push the push rod connected to each target node to straighten the scraper.
  • each of the B brackets is provided with an inertial measurement unit IMU and a stroke sensor, and the stroke sensor is arranged on the drive mechanism of the push rod;
  • the IMU is used to measure the angular velocity of the bracket Information and acceleration information, angular velocity information and acceleration information are used to control the equipment to determine the attitude angle information and position information of the bracket;
  • the travel sensor is used to measure the frame displacement information and push displacement information of the bracket, and the frame displacement information and push displacement information are combined with attitude
  • the angle information and position information are used for the control equipment to determine the coordinate information of the target node on the scraper machine.
  • the processing unit is configured to: determine the position information of each bracket in the straightening direction of the B brackets, and the position information corresponding to the straightening direction of each bracket in the B brackets The first difference of a target value; the first difference of each bracket in the B brackets, and the quotient of the cosine data of each bracket in the straightening direction in the B brackets are determined as the first adjustment amount; wherein, the cosine The data includes the first cosine, or the product of the first cosine and at least one of the second cosine and the third cosine, and the first cosine is the cosine of the heading angle of each of the B supports in the straightening direction , the second cosine is the cosine of the roll angle of each of the B brackets in the straightening direction, the third cosine is the cosine of the pitch angle of each of the B brackets in the straightening direction, the heading angle, roll angle The roll angle and the pitch angle are included in the attitude
  • the processing unit is further configured to: determine a first curve according to the position information of each of the B brackets, where the first curve is used to describe the position distribution of the B brackets; if In the first curve, the maximum peak value or the maximum valley value in the straightening direction exceeds the first threshold value, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the second threshold value, then the determination of the first adjustment amount is performed. step.
  • the processing unit is configured to: according to the position information of each bracket in the B brackets, and the length value of the push rod of each bracket in the B brackets, and the B brackets
  • the attitude angle information of each bracket in the bracket determines the coordinate information of each target node; determines the coordinate information of each target node in the straightening direction, and the second target value corresponding to each target node in the straightening direction
  • the second difference; the quotient of the second difference corresponding to each target node and the cosine data of each target node in the straightening direction is determined as the second adjustment amount;
  • the cosine data includes the fourth cosine, or , the product of the fourth cosine and at least one of the fifth cosine and the sixth cosine, the fourth cosine is the cosine of the heading angle of the push rod connected to each target node in the straightening direction, and the fifth cosine is The cosine of the roll angle of the push rod connected to each target node in the straighten
  • the processing unit is further configured to: determine a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node; if the second If the maximum peak value or the maximum valley value in the straightening direction of the curve exceeds the third threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the fourth threshold, the step of determining the second adjustment amount is executed.
  • the processing unit is further configured to: according to the measured value of the heading angle of each of the B brackets in the straightening direction and the target value of the heading angle in the straightening direction, Determine the compensation value for the heading angle of each of the B brackets.
  • the sending unit is also used to send the compensation value of the corresponding heading angle to the adjacent brackets of each bracket in the B brackets, and the compensation value of the heading angle is used for the adjacent brackets to adjust the position of each bracket in the B brackets, so that the B brackets Each bracket in the bracket is adjusted to the target value of the heading angle.
  • the control device has the function of implementing the first aspect or the method of any possible implementation manner of the first aspect.
  • This function may be implemented by hardware, or may be implemented by executing corresponding software on the hardware.
  • the hardware or software includes one or more modules corresponding to the above functions, such as the above: acquisition unit, processing unit and sending unit.
  • acquisition unit, processing unit and sending unit includes one or more modules corresponding to the above functions, such as the above: acquisition unit, processing unit and sending unit.
  • the relevant content of the third aspect or any possible implementation manner of the third aspect may be understood by referring to the first aspect and the relevant content of any possible implementation manner of the first aspect.
  • the fourth aspect of the present application provides a control device, the control device includes at least one processor, a memory, an input/output (input/output, I/O) interface, and a computer executable stored in the memory and operable on the processor Instructions, when the computer-executed instructions are executed by the processor, the processor executes the method according to the above first aspect or any possible implementation manner of the first aspect.
  • the fifth aspect of the present application provides a computer-readable storage medium storing one or more computer-executable instructions.
  • the computer-executable instructions are executed by a processor, the one or more processors execute any of the above-mentioned first aspect or first aspect.
  • the sixth aspect of the present application provides a computer program product that stores one or more computer-executable instructions.
  • the computer-executable instructions are executed by one or more processors, one or more processors execute the above-mentioned first aspect or first A method for any one of the possible implementations of the aspect.
  • the seventh aspect of the present application provides a chip system, the chip system includes at least one processor, at least one processor is used to support the control device to implement the functions involved in the first aspect or any possible implementation of the first aspect .
  • the system-on-a-chip may further include a memory, and the memory is used to store necessary program instructions and data for controlling the device.
  • the system-on-a-chip may consist of chips, or may include chips and other discrete devices.
  • the eighth aspect of the present application provides a fully mechanized mining face system, including a support array, a scraper machine, a coal shearer and control equipment.
  • the support array includes A supports, wherein, each support in the A supports is connected to each other through a push rod.
  • the scraper machine is connected, the coal shearer runs on the scraper machine, A is an integer greater than 1, and the control device is used to implement the method of the first aspect or any one of the possible implementations of the first aspect.
  • Fig. 1 is a structural representation of the fully mechanized mining face system that the embodiment of the application provides;
  • Fig. 2 is another schematic structural view of the fully mechanized mining face system provided by the embodiment of the present application.
  • Fig. 3 is a schematic diagram of an embodiment of a method for straightening multiple node devices provided by an embodiment of the present application
  • Fig. 4A is a schematic structural view of the bracket provided by the embodiment of the present application.
  • Fig. 4B is another structural schematic diagram of the stent provided by the embodiment of the present application.
  • Fig. 5 is a schematic diagram of another embodiment of a method for aligning multiple node devices provided by the embodiment of the present application.
  • Fig. 6A is a schematic diagram of the three-dimensional coordinate system provided by the embodiment of the present application.
  • Fig. 6B is another schematic diagram of the three-dimensional coordinate system provided by the embodiment of the present application.
  • Fig. 7A is a schematic diagram of an example of the first curve provided by the embodiment of the present application.
  • Fig. 7B is a schematic diagram of an example of calculating the first difference provided by the embodiment of the present application.
  • FIG. 8A is a schematic diagram of an example of an alignment method for multiple node devices provided by an embodiment of the present application.
  • FIG. 8B is a schematic diagram of another example of a method for straightening multiple node devices provided by an embodiment of the present application.
  • Fig. 8C is another example schematic diagram of the method for straightening multiple node devices provided by the embodiment of the present application.
  • FIG. 8D is a schematic diagram of another example of a method for straightening multiple node devices provided by an embodiment of the present application.
  • FIG. 9 is a schematic diagram of another example of an alignment method for multiple node devices provided by an embodiment of the present application.
  • FIG. 10 is a schematic structural diagram of a control device provided by an embodiment of the present application.
  • Fig. 11 is another schematic structural diagram of the control device provided by the embodiment of the present application.
  • the present application provides a method for straightening multi-node equipment, which is used for automatically straightening support arrays and/or scrapers in a fully mechanized mining face system.
  • Embodiments of the present application also provide corresponding devices, devices, computer-readable storage media, and computer program products. Each will be described in detail below.
  • the three machines of the fully mechanized mining face system in the coal mine include a shearer, a support array and a scraper conveyor, and the scraper conveyor is also called a scraper conveyor.
  • the supports in the support array may be hydraulic supports, pneumatic supports or electric supports. In the embodiment of the present application, a hydraulic support is taken as an example for introduction.
  • the structure of the fully mechanized mining face system in the embodiment of the present application can be understood by referring to a schematic structural diagram of the fully mechanized mining face system shown in FIG. 1 .
  • the three machines of the fully mechanized mining face system include a shearer 101, a hydraulic support 102 and a scraper conveyor 103, and the scraper conveyor is also called a scraper conveyor.
  • the scraper machine 103 is equivalent to the track of the coal shearer 101, and the coal shearer 101 walks from one end of the scraper machine 103 to the other end to complete a one-shot coal mining work. Then the hydraulic support 102 moves to the direction perpendicular to the coal face, and the scraper machine 103 is pushed to move also to the direction perpendicular to the coal face. coal work.
  • the fully mechanized mining face system includes not only the shearer 101, the hydraulic support 102, and the scraper machine 103 shown in Fig. 1, but also other equipment, including control equipment usually arranged in the control room.
  • the control device communicates with each bracket, and can obtain the position information and attitude angle information of the bracket from the bracket, and then send control information to the bracket, and then control the bracket to move or push.
  • the control equipment can be computer equipment.
  • the control equipment refers to the equipment that controls the work of the three coal cutting machines at the fully mechanized mining face.
  • rack moving and “pushing” can be understood as commonly used terms in the fully mechanized mining face system.
  • the moving of the rack refers to the movement after the support lowers the top beam
  • the pushing refers to the pushing and pulling of the scraper by the push rod. Machine, to realize the forward or backward of the scraper machine.
  • the embodiment of the present application provides a method for straightening multi-node equipment, which is applied to the fully mechanized mining face system shown in Figure 2 above, and the fully mechanized mining face system It includes a bracket array, a scraper machine and a control device.
  • the bracket array includes A brackets, wherein, each bracket in the A brackets is connected to the scraper machine through a push rod, and A is an integer greater than 1.
  • a multi-node device refers to multiple devices that work together, or a device has multiple nodes, and the multiple nodes work together. Multi-node devices can be rack arrays or scrapers.
  • the support array includes multiple supports, and the fully mechanized mining face system usually includes dozens or hundreds of supports, and each support can be understood as a node.
  • a scraper is usually a track connected to multiple node devices, and the part connected to a bracket can be understood as a node.
  • straightening may mean adjusting to a straight line, or not adjusting to a straight line in an absolute sense, and the allowable range of error can be understood as straightening.
  • an embodiment of the straightening method provided by the embodiment of the present application can be understood with reference to FIG. 3 .
  • an embodiment of the straightening method may include:
  • the control device acquires position information and attitude angle information of B brackets in the bracket array.
  • B A, or, B brackets are distributed among A brackets at intervals, and B is a positive integer.
  • the distribution of the B brackets on the A brackets at intervals refers to obtaining the position information and attitude angle information of a bracket at intervals of several brackets.
  • the interval may be a uniform interval, for example, acquiring position information and attitude angle information of a support every M supports or every (M ⁇ 1) supports.
  • the interval can also be uneven intervals, for example: for the supports in the support array, some obtain the position information and attitude angle information of a support at intervals of (M-1) supports, and some obtain the position information and attitude of a support at intervals of P supports
  • For the angle information it is also possible to obtain the position information and attitude angle information of a bracket at intervals of Q brackets, and the specific interval method is not limited in this application.
  • the position includes information of one or more translational degrees of freedom among the three translational degrees of freedom.
  • the three translational degrees of freedom include x-axis translation, y-axis translation, and z-axis translation.
  • translation on one or two axes can also be included, such as: x-axis translation, x-axis translation And y-axis translation, in fact, the translation of one axis or two axes can also be understood as a special three-axis translation, except that the translation amount on the other two axes or one axis is 0.
  • the pose includes information on one or more of the three rotational degrees of freedom.
  • the three rotational degrees of freedom include x-axis rotation, y-axis rotation, and z-axis rotation. Of course, it can also include rotation on one or two axes, such as: x-axis rotation, x-axis rotation And y-axis rotation, in fact, the rotation of one axis or two axes can also be understood as a special three-axis rotation, except that the rotation amount on the other two axes or one axis is 0.
  • the information of the translation degree of freedom can be the coordinate information describing an object in the coordinate axis, for example: the position information of each support can be the coordinate of each support on at least one of the x-axis, y-axis and z-axis information.
  • the information of the degree of freedom of rotation can describe the rotation angle of an object around the coordinate axis, such as: heading angle, roll angle or pitch angle, for example, the attitude angle information of each support can include the heading angle information of each support, roll angle At least one of angle information and pitch angle information.
  • the control device determines the first position of each bracket in the B brackets according to the position information and attitude angle information of each bracket in the B brackets, and the first target value corresponding to each bracket in the B brackets in the straightening direction.
  • the second target value of is used to determine the second adjustment value of each target node, and the target node is the connection point between the push rod of each bracket in the B brackets and the scraper machine.
  • each of the B brackets will have a corresponding first target value.
  • the control device will combine the first target value and the attitude angle information of the bracket to determine the first target value.
  • One adjustment amount so that each of the B brackets can be controlled to move to a position corresponding to the first target value, and then the bracket array can be straightened.
  • the target node is the node connected to the push rod of the support on the scraper machine.
  • the attitude angle information of the push rod is the same as that of the support.
  • the length value of the push rod represents the distance from the support to the target node.
  • each target node will have a corresponding second target value.
  • the control device will combine the second target value and the attitude angle information of the bracket to determine the second adjustment. Amount, so as to control the push rod of each bracket in the B brackets to move the corresponding target node on the scraper machine, and then straighten the scraper machine.
  • both the first target value and the second target value are numerical values
  • the first target value represents the straightening target of the bracket in the straightening direction
  • the second target value represents the adjustment of the target node of the scraper machine in the straightening direction Straight target.
  • the control device sends the corresponding first adjustment amount and/or the second adjustment amount to each of the B racks.
  • the first adjustment amount is used for each bracket of the B brackets to move in the straightening direction to straighten the bracket array
  • the second adjustment amount is used for pushing the push rod connected to each target node to straighten the scraper. trigger.
  • the rack moves according to the first adjustment amount to straighten the rack array, and/or pushes and slides according to the second adjustment amount to straighten the scraper.
  • the automatic straightening of the support array and/or the scraper machine can be realized through the control equipment, and the automation of the straightening of the support array and/or the scraper machine is realized.
  • the straightening of the support array and The attitude angle information of the support is also fully considered during the /or scraper machine, which improves the alignment accuracy of the bracket array and/or the scraper machine.
  • the method of obtaining the position information and attitude angle information of the B brackets in the bracket array in the above step 201 may be to obtain the angular velocity information and acceleration information of the brackets from each bracket in the B brackets, and then the control device determines the brackets according to the angular velocity information and acceleration information.
  • the attitude angle information and position information of the support may also be obtained directly by the control device from the attitude angle information and position information of the support calculated by the calculation unit on the support.
  • the angular velocity information and acceleration information of the bracket are measured by an inertial measurement unit (IMU) installed on the bracket.
  • IMU inertial measurement unit
  • a stroke sensor is also installed on the bracket, and the stroke sensor is arranged on the driving mechanism of the push rod. The stroke sensor is used to measure the frame displacement information and the push displacement information of the support.
  • the frame displacement information and the push displacement information are combined with the attitude angle information and
  • the position information is used by the control device to determine the coordinate information of the target node on the scraper machine.
  • each of the B brackets is provided with an inertial measurement unit (IMU) and a travel sensor.
  • IMU inertial measurement unit
  • other brackets may also be provided with an IMU or/and a travel sensor.
  • the embodiment of the present application also provides a support in a fully mechanized mining face system, the support is provided with an inertial measurement unit (IMU) and a travel sensor, and the travel sensor is provided on the drive mechanism of the push rod of the support;
  • the IMU is used for Measure the angular velocity information and acceleration information of the support, and the angular velocity information and acceleration information are used to control the equipment to determine the attitude angle information and position information of the support;
  • the stroke sensor is used to measure the frame displacement information and push displacement information of the support, and the frame displacement information and push displacement information Displacement information combined with attitude angle information and position information is used for the control equipment in the fully mechanized mining face system to determine the coordinate information of the target node on the scraper machine in the fully mechanized mining face system.
  • the target node is the connection point between the push rod of the support and the scraper machine.
  • the structure of the bracket in the bracket array provided by the embodiment of the present application can be understood with reference to FIG. 4A.
  • push rod 307 As shown in FIG. 306 , push rod 307 , side guard 308 , IMU 309 and stroke sensor 310 .
  • one end of the rear connecting rod 302, the front connecting rod 305 and the column 306 is respectively arranged on the base 301, and the push rod 307 is arranged on a driving mechanism of the base.
  • the base can be provided with multiple driving mechanisms, Such as: the drive mechanism in the x-axis direction, the drive mechanism in the y-axis direction, the drive mechanism in the z-axis direction, the push rod 307 in FIG.
  • the direction of motion of the driving mechanism in the axial direction is consistent.
  • the stroke sensor 310 is also disposed on the driving mechanism in the y-axis direction, and of course, the stroke sensor may also be disposed on the driving mechanism in other axis directions.
  • the stroke sensor 310 can measure the rack displacement information and push displacement information of the support.
  • the other end of the rear link 302 and the front link 305 is connected with the cover beam 303, the other end of the cover beam 303 and the column 306 is connected with the top beam 304, one end of the top beam 304 is connected with the cover beam 303, the middle position is connected with the column 306, and One end is connected to the side guard 308 .
  • the IMU 309 is installed on the base 301 .
  • the IMU 309 can also be installed on the top beam 304 .
  • the direction of one axis of the IMU is the same as the direction of the stroke sensor. If the orientation of the stroke sensor is the same as the y-axis direction of the IMU, of course, the stroke sensor can also have an angle with the y-axis. If there is an angle, when calculating the coordinates of the target node, it needs to be considered that the stroke sensor can also be in the same direction as the y-axis. There is an angle between the axes.
  • control device can control each bracket in the bracket array to straighten the bracket array and/or straighten the scraper. It may also be that the control device controls the spaced supports in the support array to perform straightening of the support array and/or straightening of the scraper. Introduce them separately below.
  • the control device controls each bracket in the bracket array to straighten the bracket array and/or straighten the scraper.
  • another embodiment of the method for straightening multi-node equipment includes:
  • the control device obtains the angular velocity information and acceleration information of the support measured by the IMU from each support in the support array, and the rack displacement information and push displacement information of the support measured by the travel sensor.
  • the control device determines the position information and attitude angle information of each support according to the angular velocity information and acceleration information of each support.
  • the position information of the bracket may be the three-dimensional coordinates of the bracket. Taking the nth bracket as an example, the three-dimensional coordinates of the nth bracket may be marked as (Xn, Yn, Zn).
  • the attitude angle information of the support can be the pitch angle, heading angle and roll angle of the support on the three-dimensional coordinate system. Taking the n-th support as an example, the attitude angle information of the n-th support can be expressed as ( ⁇ nx, ⁇ ny, ⁇ nz), where ⁇ nx is the pitch angle, ⁇ ny is the heading angle, and ⁇ nz is the roll angle.
  • the three-dimensional coordinate system in the embodiment of the present application can be understood by referring to FIG. 6A.
  • the direction parallel to the coal surface is defined as the x-axis
  • the direction perpendicular to the coal surface is defined as the y-axis
  • the x-axis and the y-axis The direction perpendicular to the plane is defined as the z-axis.
  • ⁇ x is the pitch angle, indicating the angle between the y-axis and the x-axis.
  • ⁇ y is the heading angle, indicating the angle between the z-axis and the y-axis.
  • ⁇ z is the roll angle, indicating the angle between the x-axis and the y-axis.
  • the attitude angle information ( ⁇ nx, ⁇ ny, ⁇ nz) of the bracket can also be expressed in another form, as shown in Figure 6B, using the angle between the projection of the bracket in the three-dimensional coordinate system and the three axes x, y, and z Indicates ⁇ nx, ⁇ ny, ⁇ nz.
  • the control device determines a first curve according to the position information of each support, where the first curve is used to describe the position distribution of each support.
  • the position information of each support is the coordinates of each support, and the coordinates of the nth support in the straightening direction can be expressed as (Xn, Yn, Zn).
  • the coordinates of each support on the y-axis can be expressed as (X1, Y1, Z1), (X2, Y2, Z2), . . . , (Xn, Yn, Zn).
  • the first curve may be a curve formed by connecting coordinate points of n supports.
  • the first curve can be understood with reference to FIG. 7A .
  • the coordinate points of each bracket can be connected by a straight line.
  • the first curve provided in the embodiment of the present application is not limited to the manner shown in FIG. 7A , and may also be a curve obtained by fitting the coordinates of each bracket.
  • the control device determines that each The position information of the bracket in the straightening direction, and the first difference between the first target value corresponding to each bracket in the straightening direction.
  • the step of determining the first difference and the first adjustment amount is not performed.
  • condition 1 the maximum peak value or maximum valley value in the straightening direction in the first curve exceeds the first threshold
  • condition 2 the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds second threshold.
  • condition 1 and condition 2 only one of condition 1 and condition 2 needs to be selected, and these two conditions can be a pre-configured one, and condition 1 is configured in the control device, and condition 1 is executed during operation.
  • Condition 2 is configured in the control device, and condition 2 is executed at runtime.
  • the first threshold and the second threshold may be preconfigured values, such as: 1 cm to 50 cm, or other values, if the maximum peak value or the maximum valley value in the straightening direction in the first curve does not exceed the first threshold value, or The difference between the maximum peak value and the maximum trough value in the straightening direction does not exceed the second threshold, which means that the current support array is relatively straight and does not need to perform straightening processing, which can save time for straightening and improve the shearer. work efficiency.
  • the first difference is the difference between the first target value and the coordinate value of the bracket in the straightening direction.
  • the difference can be positive or negative.
  • a positive value means the same as the straightening direction, and a negative value Indicates that it is opposite to the straightening direction.
  • the straightening direction as the y-axis as an example
  • the coordinate of the nth support in the y-axis direction is Yn
  • the corresponding first target value is Fn
  • the first target value of each bracket can also be represented by a straight line, as shown in Figure 7B, the straight line F represents the straight line where the first target value of each bracket is located, and the straight line F shown in Figure 7B is parallel to the x-axis Yes, in fact, the straight line F can also be angled with respect to the x-axis, not limited to the way shown in FIG. 7B.
  • the first difference of each bracket is the distance from the coordinate point of each bracket to the straight line F.
  • the control device determines the quotient of the first difference value of each support and the cosine data of each support in the straightening direction as the first adjustment amount.
  • the cosine data includes the first cosine, or the product of the first cosine and at least one of the second cosine and the third cosine
  • the first cosine is the heading of each bracket in the straightening direction in the B brackets
  • the second cosine is the cosine of the roll angle of each bracket in the B brackets in the straightening direction
  • the third cosine is the cosine of the pitch angle of each bracket in the B brackets in the straightening direction
  • the heading Angle, roll angle, and pitch angle are included in the attitude angle information of each bracket in the B brackets.
  • the first adjustment amount (Fn-Yn)/cosine data
  • the first cosine cos ⁇ ny
  • the second cosine cos ⁇ nz
  • the third cosine cos ⁇ nx
  • the cosine data can be cos ⁇ ny or cos ⁇ ny.cos ⁇ nz, cos ⁇ ny.cos ⁇ nx or cos ⁇ ny.cos ⁇ nz.cos ⁇ nx, where ".” represents the multiplication sign.
  • the present application takes into account various angle factors that may be affected by the bracket, so that the calculated first adjustment amount is more accurate, and further improves the alignment accuracy of the bracket array.
  • the control device determines the coordinate information of each target node according to the position information of each support, the protruding length value of the push rod of each support, and the attitude angle information of each support.
  • the control device determines a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node.
  • the target node is the node connected with the push rod on the bracket on the scraper machine.
  • the second curve can be understood with reference to FIG. 7A of the first curve.
  • control device determines that every The second difference between the coordinate information of each target node in the straightening direction and the second target value corresponding to each target node in the straightening direction.
  • the step of determining the second difference and the second adjustment amount is not performed.
  • condition 3 the maximum peak value or maximum valley value in the straightening direction in the second curve does not exceed the third threshold
  • condition 4 the difference between the maximum peak value and the maximum valley value in the straightening direction
  • the fourth threshold is not exceeded.
  • condition 3 and condition 4 only one of condition 3 and condition 4 needs to be selected, and these two conditions can be a pre-configured one, and condition 3 is configured in the control device, and condition 3 is executed during operation.
  • Condition 4 is configured in the control device, and condition 4 is executed at runtime.
  • the third threshold and the fourth threshold can be pre-configured values, such as: 1 cm to 50 cm, or other values, if the maximum peak or maximum valley value in the second curve does not exceed the third threshold, or in the straightening direction.
  • the difference between the maximum peak value and the maximum valley value does not exceed the fourth threshold, which means that the current scraper is relatively straight and does not need to be straightened, which can save time for straightening and improve the working efficiency of the shearer .
  • the second difference is the difference (En-bn) between the second target value En and bn.
  • the difference can be positive or negative.
  • a positive value means the same direction as the straightening direction, and a negative value means Opposite to straightening direction.
  • the calculation method of the second difference can be understood by referring to the calculation method of the first difference, and can also be understood by referring to FIG. 7B .
  • the control device determines the quotient of the second difference corresponding to each target node and the cosine data of each target node in the straightening direction as the second adjustment amount.
  • the cosine data includes the fourth cosine, or the product of the fourth cosine and at least one of the fifth cosine and the sixth cosine
  • the fourth cosine is the straightening direction of the push rod connected to each target node
  • the fifth cosine is the cosine of the roll angle of the push rod connected to each target node in the straightening direction
  • the sixth cosine is the roll angle of the push rod connected to each target node in the straightening direction
  • the cosine of the pitch angle, heading angle, roll angle, and pitch angle are included in the attitude angle information of the push rod connected to each target node
  • the attitude angle information of the push rod connected to each target node is the bracket where the push rod is located attitude angle information.
  • the fourth cosine is the same as the first cosine
  • the fifth cosine is the same as the second cosine
  • the sixth cosine is the same as the first cosine.
  • the three cosines are the same.
  • the fourth cosine cos ⁇ ny
  • the fifth cosine cos ⁇ nz
  • the sixth cosine cos ⁇ nx
  • the cosine data can be cos ⁇ ny, cos ⁇ ny.cos ⁇ nz, cos ⁇ ny.cos ⁇ nx or cos ⁇ ny.cos ⁇ nz.cos ⁇ nx.
  • the present application takes into account various angle factors that may be affected by the push rod when calculating the second adjustment amount, so that the calculated second adjustment amount is more accurate, and further improves the straightening accuracy of the scraper machine.
  • the control device sends the corresponding first adjustment amount and/or the second adjustment amount to each bracket.
  • the bracket moves according to the first adjustment amount to straighten the bracket array, and/or pushes and slides according to the second adjustment amount to straighten the scraper.
  • bracket array needs to be straightened, only the first adjustment amount needs to be determined, and the second adjustment amount does not need to be determined, and steps 406 to 409 do not need to be performed. If it is only necessary to straighten the scraper, only the second adjustment amount needs to be determined, and the first adjustment amount does not need to be determined, so steps 403 to 405 do not need to be performed. If it is necessary to straighten both the bracket array and the scraper, it is necessary to determine the first adjustment amount and the second adjustment amount.
  • two adjacent brackets in the bracket array can push the other bracket to rotate by a certain angle through the driving mechanisms on both sides.
  • the straightening direction is the y-axis direction
  • the x-axis direction can The push rod of the stent is used to push the adjacent stent to rotate, so as to adjust the angular rotation of the stent in the stent array.
  • This process can be that the control device determines the compensation value of the heading angle of each bracket according to the measured value of the heading angle of each bracket in the straightening direction and the target value of the heading angle in the straightening direction;
  • the adjacent brackets send the compensation value corresponding to the heading angle, which is used for the adjacent brackets to adjust the position of each bracket, so as to adjust each bracket to the target value of the heading angle.
  • the compensation value of the course angle includes the compensation value of the angle and the displacement compensation value of the push rod that pushes the adjacent support. If the direction parallel to the coal surface is the x-axis, the push rod of the adjacent support Push rods generally refer to push rods in the x-axis direction.
  • the compensation value of the angle can be the difference between the target value of the heading angle and the measured value of the heading angle, and the pushing compensation value of the push rod can be determined according to the length of the bottom plate of the bracket in the Y-axis direction and the compensation value of the angle. The distance that the bracket needs to move in the x-axis direction.
  • the embodiment of the present application can straighten the scraper machine and/or the bracket array and adjust the heading angle by monitoring the straightness of the target node of the support array and the scraper machine, as shown in Figure 8A to Figure 8D below Demonstrate the straightening and adjustment process.
  • brackets in the bracket array there are n brackets in the bracket array, and the position information of each bracket can be represented by three-dimensional coordinates, and the specific representation method can refer to the above introduction. It can be seen from the straightness monitoring stent array diagram that both the first curve and the second curve are curves. Then the scraper machine and/or bracket array can be straightened according to the previous scheme.
  • the above-mentioned adjustment process from Figure 8A to Figure 8D can be based on the coordinates (xn, yn, zn) of the control device, the three-dimensional posture ( ⁇ x, ⁇ y, ⁇ z), and the coordinates of the target node of the scraper (an, bn ,cn), to obtain the distribution state of the bracket array and the scraper machine in space.
  • This embodiment takes straightening in the Y-axis direction as an example, that is, fitting the straightness of the Y-axis coordinates of the target nodes of the bracket array and the scraper machine, and judging the maximum difference of the Y-axis coordinates, which are recorded as H and K respectively, to realize real-time alignment. Monitor directly.
  • the bracket array can be straightened by compensating with the machine, that is, the Y-axis coordinates of the bracket array are aligned, so that H ⁇ G, G is the target value of straightening, and the range can be 0 to 50cm .
  • Set the target Y-axis coordinate value calculate the difference L between the Y-axis coordinate of the support and the target value, and then obtain the compensation amount of the follower frame for each support.
  • the follower frame can adjust the positive and negative distances by lowering the frame and telescopic push rod.
  • the telescopic amount of the push rod (dns–dn) is equal to L divided by the cosine of the heading angle. When the ground is uneven, it must be further divided by the cosine of the roll and pitch angles.
  • the scraper machine can be straightened through the bracket pushing compensation, that is, the Y-axis coordinates of the scraper machine nodes are aligned, so that K ⁇ G, G is the target value of straightening, and the range can be 0 ⁇ 50cm.
  • Set the target Y-axis coordinate value calculate the difference T between the Y-axis coordinate of the scraper node and the target value, and then obtain the push rod push compensation amount of each scraper node.
  • the telescopic amount of the push rod (dnt–dn) is equal to T divided by the cosine of the heading angle. When the ground is uneven, it must be further divided by the cosine of the roll and pitch angles.
  • the solution provided by the embodiment of the present application can realize the automatic alignment of the bracket array and/or the scraper machine through the position information and attitude angle information of each bracket in the direct array, and the alignment accuracy is very high.
  • the control device controls the spaced brackets in the bracket array to perform straightening of the bracket array and/or the straightening of the scraper machine.
  • the IMU and the travel sensor can be installed at even intervals. As shown in FIG. 9 , the IMU and the travel sensor are installed on every M brackets, and the value of M usually ranges from 0 to 20. There are nM brackets in Figure 9, so that the position information and attitude angle information of n brackets can be obtained, and then the bracket array and/or the scraper machine can be straightened. For the specific straightening process, please refer to the previous part of Figure 5 to Figure 8D The introduction is understood, and the introduction will not be repeated here.
  • FIG. 9 uses uniform intervals as an example for introduction.
  • the method is not limited to uniform intervals, and may also be uneven intervals.
  • the method of installing the IMU and the stroke sensor at intervals provided by the embodiment of the present application can reduce the hardware cost and achieve the effect of straightening the bracket array and/or the scraper.
  • control device 50 provided by the embodiment of the present application is included in the fully mechanized mining face system, and the control device is included in the fully mechanized mining face system.
  • a bracket wherein, each bracket in the A brackets is connected to the scraper machine through a push rod, A is an integer greater than 1, and the control device includes:
  • the obtaining unit 501 may execute steps 201 and 401 in the foregoing method embodiments.
  • the processing unit 502 is configured to determine the B brackets according to the position information and attitude angle information of each bracket in the B brackets acquired by the acquisition unit 501, and the first target value corresponding to each bracket in the B brackets in the straightening direction
  • Up to the second target value corresponding to each target node, determine the second adjustment amount of each target node, the target node is the connection point between the push rod of each bracket in the B brackets and the scraper machine.
  • the processing unit 502 may execute steps 202 and 402-409 in the foregoing method embodiments.
  • the sending unit 503 is configured to send the first adjustment amount and/or the second adjustment amount determined by the corresponding processing unit 502 to each bracket in the B brackets, the first adjustment amount is used for each bracket in the B brackets in the straightening direction
  • the rack moves upwards to straighten the bracket array, and the second adjustment amount is used to push the push rods connected to each target node to straighten the scraper.
  • the sending unit 503 may execute steps 203 and 410 in the foregoing method embodiments.
  • the automatic straightening of the support array and/or the scraper machine can be realized through the control equipment, and the automation of the straightening of the support array and/or the scraper machine is realized.
  • the straightening of the support array and The attitude angle information of the support is also fully considered during the /or scraper machine, which improves the alignment accuracy of the bracket array and/or the scraper machine.
  • each bracket in the B brackets is provided with an inertial measurement unit IMU and a travel sensor, and the travel sensor is arranged on the drive mechanism of the push rod;
  • the IMU is used to measure the angular velocity information and acceleration information of the bracket, angular velocity information and acceleration
  • the information is used to control the equipment to determine the attitude angle information and position information of the bracket;
  • the travel sensor is used to measure the rack displacement information and push displacement information of the bracket, and the rack displacement information and push displacement information are combined with attitude angle information and position information to control the equipment Determine the coordinate information of the target node on the scraper.
  • the processing unit 502 is configured to: determine the position information of each of the B brackets in the straightening direction, and the first difference from the first target value corresponding to each of the B brackets in the straightening direction ; The first difference of each bracket in the B brackets, and the quotient of the cosine data of each bracket in the straightening direction in the B brackets are determined as the first adjustment amount; wherein the cosine data includes the first cosine, or , the product of the first cosine and at least one of the second cosine and the third cosine, the first cosine is the cosine of the heading angle of each bracket in the straightening direction in the B brackets, and the second cosine is the B brackets The cosine of the roll angle of each bracket in the straightening direction, the third cosine is the cosine of the pitch angle of each bracket in the B brackets in the straightening direction, the heading angle, roll angle, and pitch angle are included in B In the attitude angle information of each bracket in a
  • the processing unit 502 is further configured to: determine the first curve according to the position information of each bracket in the B brackets, the first curve is used to describe the position distribution of the B brackets; if the first curve is in the straightening direction If the maximum peak value or the maximum valley value exceeds the first threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the second threshold, the step of determining the first adjustment amount is executed.
  • the processing unit 502 is configured to: according to the position information of each bracket in the B brackets, and the length value of the push rod of each bracket in the B brackets, and the attitude angle of each bracket in the B brackets information, determine the coordinate information of each target node; determine the coordinate information of each target node in the straightening direction, and the second difference between the second target value corresponding to each target node in the straightening direction; each The quotient of the second difference corresponding to the target node and the cosine data of each target node in the straightening direction is determined as the second adjustment amount; wherein, the cosine data includes the fourth cosine, or the fourth cosine and the fifth cosine The product of at least one of the cosine and the sixth cosine, the fourth cosine is the cosine of the heading angle of the push rod connected to each target node in the straightening direction, and the fifth cosine is the The cosine of the roll angle of the stick in the straightening direction, the sixth cosine is
  • the processing unit 502 is further configured to: determine a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node; if the maximum in the straightening direction in the second curve If the peak value or the maximum valley value exceeds the third threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the fourth threshold, the step of determining the second adjustment amount is executed.
  • the processing unit 502 is further configured to: determine each of the B brackets according to the measured value of the heading angle of each bracket in the straightening direction and the target value of the heading angle in the straightening direction. The compensation value of the heading angle.
  • the sending unit 503 is also used to send the compensation value of the corresponding heading angle to the adjacent brackets of each bracket in the B brackets, and the compensation value of the heading angle is used for the adjacent brackets to adjust the position of each bracket in the B brackets, so that B Each of the two brackets is adjusted to the target value of the heading angle.
  • control device 50 provided in the embodiment of the present application can be understood by referring to the corresponding content in the foregoing method embodiment, and will not be repeated here.
  • FIG. 11 is a schematic diagram of a possible logical structure of the control device 60 provided by the embodiment of the present application.
  • the control device 60 includes: a processor 601 , a communication interface 602 , a memory 603 , a disk 604 and a bus 605 .
  • Processor 601, communication interface 602, memory 603, and disk 604 are connected to each other through bus 605.
  • the processor 601 is used to control and manage the actions of the control device 60 , for example, the processor 601 is used to execute the steps in the method embodiments in FIGS. 1 to 9 .
  • the communication interface 602 is used to support the control device 60 to communicate.
  • the memory 603 is used to store program codes and data of the control device 60 and provide memory space for processes or threads. Disk user stores physical pages swapped out from memory.
  • the processor 601 may be a central processing unit, a general processor, a digital signal processor, an application specific integrated circuit, a field programmable gate array or other programmable logic devices, transistor logic devices, hardware components or any combination thereof. It can implement or execute the various illustrative logical blocks, modules and circuits described in connection with the present disclosure.
  • the processor 601 may also be a combination that implements computing functions, for example, a combination of one or more microprocessors, a combination of a digital signal processor and a microprocessor, and the like.
  • the bus 605 may be a Peripheral Component Interconnect (PCI) bus or an Extended Industry Standard Architecture (Extended Industry Standard Architecture, EISA) bus, etc.
  • PCI Peripheral Component Interconnect
  • EISA Extended Industry Standard Architecture
  • a computer-readable storage medium is also provided, and computer-executable instructions are stored in the computer-readable storage medium.
  • the processor of the device executes the computer-executable instructions
  • the device executes the above-mentioned Figs. Steps performed by the control device in FIG. 9 .
  • a computer program product includes computer-executable instructions stored in a computer-readable storage medium; when the processor of the device executes the computer-executable instructions , the device executes the steps performed by the control device in FIGS. 1 to 9 above.
  • a chip system is further provided, and the chip system includes a processor, and the processor is used to control the device to implement the steps performed by the control device in the foregoing FIGS. 1 to 9 .
  • the system-on-a-chip may further include a memory, and the memory is used to store necessary program instructions and data for controlling the device.
  • the system-on-a-chip may consist of chips, or may include chips and other discrete devices.
  • the disclosed systems, devices and methods may be implemented in other ways.
  • the device embodiments described above are only illustrative.
  • the division of units is only a logical function division. In actual implementation, there may be other division methods.
  • multiple units or components can be combined or integrated. to another system, or some features may be ignored, or not implemented.
  • the mutual coupling or direct coupling or communication connection shown or discussed may be through some interfaces, and the indirect coupling or communication connection of devices or units may be in electrical, mechanical or other forms.
  • a unit described as a separate component may or may not be physically separated, and a component shown as a unit may or may not be a physical unit, that is, it may be located in one place, or may be distributed to multiple network units. Part or all of the units can be selected according to actual needs to achieve the purpose of the solution of this embodiment.
  • each functional unit in each embodiment of the embodiment of the present application may be integrated into one processing unit, each unit may exist separately physically, or two or more units may be integrated into one unit.
  • the functions are realized in the form of software functional units and sold or used as independent products, they can be stored in a computer-readable storage medium.
  • the technical solution of the embodiment of the present application is essentially or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium , including several instructions to make a computer device (which may be a personal computer, a server, or a network device, etc.) execute all or part of the steps of the methods in the various embodiments of the embodiments of the present application.
  • the aforementioned storage media include: U disk, mobile hard disk, read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), magnetic disk or optical disc and other media that can store program codes. .

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Image Analysis (AREA)
  • Electrolytic Production Of Metals (AREA)

Abstract

A straightening method for a multi-node device, used for automatically straightening a hydraulic support array and/or automatically straightening a scraper in a fully mechanized coal mining face system. The method comprises: a control device determines a first adjustment amount by means of position information and attitude angle information of hydraulic supports and a first target value of each hydraulic support in a hydraulic support array in a straightening direction, so that each hydraulic support adjusts the hydraulic support array according to the first adjustment amount, and/or the control device determines a second adjustment amount by means of the position information and attitude angle information of the hydraulic supports, the value of the length of extension of a push rod of each hydraulic support, and a second target value of a target node on the scraper connected to each push rod, so that each hydraulic support can perform a push operation on the scraper by means of the push rod so as to straighten the scraper. According to the method, the attitude angle information of the supports is fully considered during straightening of the support array and/or the scraper, thereby improving the straightening accuracy of the support array and/or the scraper.

Description

一种多节点设备的调直方法及相应设备Straightening method for multi-node equipment and corresponding equipment
本申请要求于2022年01月29日提交中国专利局、申请号为202210111713.X、发明名称为“一种多节点设备的调直方法及相应设备”的中国专利申请的优先权,其全部内容通过引用结合在本申请中。This application claims the priority of the Chinese patent application with the application number 202210111713.X and the title of the invention "A method for aligning multi-node equipment and corresponding equipment" submitted to the China Patent Office on January 29, 2022, the entire content of which Incorporated in this application by reference.
技术领域technical field
本申请涉及计算机技术领域,尤其涉及一种多节点设备的调直方法及相应设备。The present application relates to the field of computer technology, in particular to a method for straightening multi-node equipment and corresponding equipment.
背景技术Background technique
煤矿井下综采面割煤三机指的是采煤机、液压支架和刮板机,刮板机也称刮板运输机。上百个或几百个液压支架按照要求排列,并分别与刮板机相连,构成采煤机的行走轨道。采煤机沿着轨道运动,同时采煤机的滚筒进行割煤。通常综采面三机具有“三直一平”的严格要求,三直主要指液压支架的阵列要直、刮板机要直、采煤机割煤的煤面要直。The three coal-cutting machines in the fully mechanized mining face of the coal mine refer to the coal shearer, the hydraulic support and the scraper machine, and the scraper machine is also called the scraper conveyor. Hundreds or hundreds of hydraulic supports are arranged according to requirements, and are respectively connected with the scraper machine to form the walking track of the coal mining machine. The shearer moves along the track, while the drum of the shearer cuts coal. Usually, the three machines in the fully mechanized mining face have strict requirements of "three straights and one leveling". The three straights mainly refer to the straightness of the array of hydraulic supports, the straightness of the scraper machine, and the straightness of the coal face cut by the shearer.
当前综采面依赖人工操作液压支架进行液压支架阵列的调直,当矿井少人、无人时必然面临需要通过自动化的方式进行调直的问题。当前该领域尚无成熟技术方案,能解决液压支架阵列和刮板机的调直问题。At present, fully mechanized mining faces rely on manual operation of hydraulic supports to straighten hydraulic support arrays. When there are few people and no one in the mine, it is inevitable to face the problem of straightening through automatic methods. At present, there is no mature technical solution in this field, which can solve the straightening problem of hydraulic support array and scraper machine.
发明内容Contents of the invention
本申请提供了一种多节点设备的调直方法,用于自动调直综采面系统中的支架阵列和/或刮板机。本申请实施例还提供了相应的装置、设备、计算机可读存储介质,以及计算机程序产品等。The present application provides a method for straightening multi-node equipment, which is used for automatically straightening support arrays and/or scrapers in a fully mechanized mining face system. Embodiments of the present application also provide corresponding devices, devices, computer-readable storage media, and computer program products.
本申请第一方面提供一种多节点设备的调直方法,该方法应用于综采面系统,综采面系统包括支架阵列、刮板机和控制设备,支架阵列包括A个支架,其中,A个支架中的每个支架都通过推杆与刮板机连接,A为大于1的整数,该方法包括:控制设备获取支架阵列中B个支架的位置信息和姿态角信息,B=A,或者,B个支架间隔分布在A个支架中,B为正整数;控制设备根据B个支架中每个支架的位置信息和姿态角信息,以及在调直方向上B个支架中每个支架对应的第一目标值,确定B个支架中每个支架的第一调节量,和/或,根据B个支架中每个支架的位置信息和姿态角信息、B个支架中每个支架的推杆伸出的长度值,以及在调直方向上每个目标节点所对应的第二目标值,确定每个目标节点的第二调节量,目标节点为B个支架中每个支架的推杆与刮板机的连接点;控制设备向B个支架中每个支架发送对应的第一调节量和/或第二调节量,第一调节量用于B个支架中每个支架在调直方向上进行拉架移动,以调直支架阵列,第二调节量用于每个目标节点所连接的推杆进行推溜,以调直刮板机。The first aspect of the present application provides a method for straightening multi-node equipment. The method is applied to a fully mechanized mining face system. The fully mechanized mining face system includes a bracket array, a scraper machine and control equipment. The bracket array includes A brackets, where A Each bracket in the brackets is connected to the scraper machine through a push rod, and A is an integer greater than 1. The method includes: the control device obtains the position information and the attitude angle information of the B brackets in the bracket array, B=A, or , the B brackets are distributed in the A brackets at intervals, and B is a positive integer; the control device is based on the position information and attitude angle information of each bracket in the B brackets, and the corresponding first position of each bracket in the B brackets in the straightening direction A target value, determine the first adjustment amount of each bracket in the B brackets, and/or, according to the position information and attitude angle information of each bracket in the B brackets, the push rod of each bracket in the B brackets extends The length value of , and the second target value corresponding to each target node in the straightening direction, determine the second adjustment value of each target node, the target node is the push rod of each bracket in the B brackets and the scraper machine connection point; the control device sends the corresponding first adjustment amount and/or second adjustment amount to each bracket in the B brackets, and the first adjustment amount is used for each bracket in the B brackets to move in the straightening direction, so as to To straighten the bracket array, the second adjustment amount is used to push the push rod connected to each target node to straighten the scraper.
本申请中,多节点设备指的是一起协同工作的多个设备,或者一个设备上有多个节点,多个节点一起协同工作。多节点设备可以是支架阵列,也可以是刮板机。支架阵列中包括多个支架,综采面系统中通常包括几十个或者几百个支架,每个支架都可以理解为是一个节点。刮板机通常是一条多个节点设备连接的轨道,与一个支架所连接的部分可以理解为是一个节点。本申请中,支架可以是液压支架、气动支架或电动支架。综采面系统中的支架通常为液压支架。In this application, a multi-node device refers to a plurality of devices that work together, or a device has multiple nodes, and the multiple nodes work together. Multi-node devices can be rack arrays or scrapers. The support array includes multiple supports, and the fully mechanized mining face system usually includes dozens or hundreds of supports, and each support can be understood as a node. A scraper is usually a track connected to multiple node devices, and the part connected to a bracket can be understood as a node. In this application, the support may be a hydraulic support, a pneumatic support or an electric support. The supports in the fully mechanized mining face system are usually hydraulic supports.
本申请中,控制设备可以是计算机设备,在综采面系统中控制设备指的是控制综采面 割煤三机工作的设备。In this application, the control equipment can be computer equipment, and the control equipment in the fully mechanized mining face system refers to the equipment that controls the work of the three coal cutting machines in the fully mechanized mining face.
本申请中,“调直”可以是调成一条直线,也可以不是调成绝对意义上的直线,误差允许的范围都可以理解为是调直。In the present application, "straightening" may mean adjusting to a straight line, or not adjusting to an absolute straight line, and the allowable range of error can be understood as straightening.
本申请中,B=A表示控制设备获取支架阵列中每个支架的位置信息和姿态角信息。B个支架间隔分布在A个支架指的是间隔几个支架获取一个支架的位置信息和姿态角信息。需要说明的是,间隔可以是均匀间隔,例如:每M个支架或者每隔(M-1)个支架获取一个支架的位置信息和姿态角信息。间隔也可以是不均匀间隔,例如:针对支架阵列中的支架,有的是间隔(M-1)个支架获取一个支架的位置信息和姿态角信息,有的是间隔P个支架获取一个支架的位置信息和姿态角信息,还可以有的是间隔Q个支架获取一个支架的位置信息和姿态角信息,具体的间隔方式本申请中不做限定。In this application, B=A means that the control device obtains the position information and attitude angle information of each bracket in the bracket array. The distribution of the B brackets on the A brackets at intervals refers to obtaining the position information and attitude angle information of a bracket at intervals of several brackets. It should be noted that the interval may be a uniform interval, for example, acquiring position information and attitude angle information of a support every M supports or every (M−1) supports. The interval can also be uneven intervals, for example: for the supports in the support array, some obtain the position information and attitude angle information of a support at intervals of (M-1) supports, and some obtain the position information and attitude of a support at intervals of P supports For the angle information, it is also possible to obtain the position information and attitude angle information of a bracket at intervals of Q brackets, and the specific interval method is not limited in this application.
本申请中,位置包括3种平移自由度中的一种或多种平移自由度的信息。在其中一种描述中,3种平移自由度包括x轴平移、y轴平移和z轴平移,当然,也可以包括其中一个轴或两个轴上的平移,如:x轴平移,x轴平移和y轴平移,实际上,也可以将一个轴或两个轴的平移理解为是一种特殊的三个轴的平移,只是另外的两个轴或一个轴上的平移量是0。姿态包括3种旋转自由度中的一种或多种旋转自由度的信息。在其中一种描述中,3种旋转自由度包括x轴旋转、y轴旋转和z轴旋转,当然,也可以包括其中一个轴或两个轴上的旋转,如:x轴旋转,x轴旋转和y轴旋转,实际上,也可以将一个轴或两个轴的旋转理解为是一种特殊的三个轴的旋转,只是另外的两个轴或一个轴上的旋转量是0。其中,平移自由度的信息可以是描述一个物体在坐标轴中的坐标信息,例如:每个支架的位置信息可以是每个支架在x轴、y轴、z轴中至少一个坐标轴上的坐标信息。旋转自由度的信息可以是描述一个物体绕坐标轴的旋转角度,如:航向角、横滚角或俯仰角,如,每个支架的姿态角信息可以包括每个支架的航向角信息、横滚角信息和俯仰角信息中的至少一个。In this application, the position includes information of one or more translational degrees of freedom among the three translational degrees of freedom. In one of the descriptions, the three translational degrees of freedom include x-axis translation, y-axis translation, and z-axis translation. Of course, translation on one or two axes can also be included, such as: x-axis translation, x-axis translation And y-axis translation, in fact, the translation of one axis or two axes can also be understood as a special three-axis translation, except that the translation amount on the other two axes or one axis is 0. The pose includes information on one or more of the three rotational degrees of freedom. In one of the descriptions, the three rotational degrees of freedom include x-axis rotation, y-axis rotation, and z-axis rotation. Of course, it can also include rotation on one or two axes, such as: x-axis rotation, x-axis rotation And y-axis rotation, in fact, the rotation of one axis or two axes can also be understood as a special three-axis rotation, except that the rotation amount on the other two axes or one axis is 0. Wherein, the information of the translation degree of freedom can be the coordinate information describing an object in the coordinate axis, for example: the position information of each support can be the coordinate of each support on at least one of the x-axis, y-axis and z-axis information. The information of the degree of freedom of rotation can describe the rotation angle of an object around the coordinate axis, such as: heading angle, roll angle or pitch angle, for example, the attitude angle information of each support can include the heading angle information of each support, roll angle At least one of angle information and pitch angle information.
本申请中,每个支架的姿态角信息可以包括每个支架的航向角信息、横滚角信息和俯仰角信息。In the present application, the attitude angle information of each support may include heading angle information, roll angle information and pitch angle information of each support.
本申请中,“调直方向”指的是B个支架中每个支架以及刮板机的调整方向,该调直方向可以是y轴方向,也可以是其他的任意方向,本申请中对该调直方向不做限定。In this application, "straightening direction" refers to the adjustment direction of each bracket in the B brackets and the scraper machine. The straightening direction can be the y-axis direction or any other direction. The straightening direction is not limited.
本申请中,在调直方向上,B个支架中每个支架都会有一个对应的第一目标值,考虑到支架可能受到地面不平等原因干扰,控制设备会结合第一目标值和支架的姿态角信息来确定第一调节量,从而控制B个支架中每个支架都能拉架移动到相应第一目标值的位置,进而调直支架阵列。In this application, in the straightening direction, each of the B brackets will have a corresponding first target value. Considering that the bracket may be disturbed by ground inequality, the control device will combine the first target value and the attitude angle of the bracket Information to determine the first adjustment amount, so as to control each of the B brackets to move the bracket to a position corresponding to the first target value, and then straighten the bracket array.
本申请中,目标节点是刮板机上与支架的推杆连接的节点,推杆的姿态角信息与支架的姿态角信息是相同的,推杆伸出的长度值表示的是从支架到目标节点的距离。在调直方向上,每个目标节点都会有一个对应的第二目标值,考虑到推杆可能受到地面不平等原因干扰,控制设备会结合第二目标值和支架的姿态角信息来确定第二调节量,从而控制B个支架中每个支架的推杆通过推溜,移动刮板机上的对应目标节点,进而调直刮板机。In this application, the target node is the node connected to the push rod of the bracket on the scraper machine. The attitude angle information of the push rod is the same as that of the bracket. The length value of the push rod indicates the distance from the bracket to the target node. distance. In the direction of straightening, each target node will have a corresponding second target value. Considering that the push rod may be disturbed by ground inequality, the control device will combine the second target value and the attitude angle information of the bracket to determine the second adjustment. Amount, so as to control the push rod of each bracket in the B brackets to move the corresponding target node on the scraper machine, and then straighten the scraper machine.
需要说明的是,第一目标值和第二目标值都为数值,第一目标值表示在调直方向上支架的调直目标,第二目标值表示在调直方向上刮板机的目标节点的调直目标。It should be noted that both the first target value and the second target value are numerical values, the first target value represents the straightening target of the bracket in the straightening direction, and the second target value represents the adjustment of the target node of the scraper machine in the straightening direction Straight target.
本申请中,“拉架移动”和“推溜”可以理解为是综采面系统中的常用语,拉架移动指的是支架降低顶梁后移动,推溜指的是推杆推拉刮板机,以实现刮板机前进或者后退。In this application, "cradle moving" and "pushing" can be understood as commonly used terms in the fully mechanized mining face system. Laying frame movement refers to the movement of the bracket after lowering the top beam, and pushing refers to the push rod pushing and pulling the scraper machine. In order to realize the forward or backward of the scraper machine.
上述第一方面中,可以通过控制设备自动调直支架阵列和/或刮板机,实现了对支架阵列和/或刮板机调直的自动化,另外,本申请中,在调直支架阵列和/或刮板机时还充分考虑了支架的姿态角信息,提高了支架阵列和/或刮板机调直的精准度。In the above-mentioned first aspect, the automatic straightening of the bracket array and/or the scraper machine can be achieved through the control equipment, and the automation of straightening the bracket array and/or the scraper machine is realized. In addition, in this application, in the straightening of the bracket array and the The attitude angle information of the support is also fully considered during the /or scraper machine, which improves the alignment accuracy of the bracket array and/or the scraper machine.
在第一方面的一种可能的实现方式中,B个支架中每个支架上都设置有惯性测量单元(inertial measurement unit,IMU)以及行程传感器,行程传感器设置于推杆的驱动机构上;IMU用于测量支架的角速度信息和加速度信息,角速度信息和加速度信息用于控制设备确定支架的姿态角信息和位置信息;行程传感器用于测量支架的拉架位移信息和推溜位移信息,拉架位移信息和推溜位移信息结合姿态角信息和位置信息用于控制设备确定刮板机上目标节点的坐标信息。In a possible implementation of the first aspect, each of the B brackets is provided with an inertial measurement unit (inertial measurement unit, IMU) and a stroke sensor, and the stroke sensor is arranged on the drive mechanism of the push rod; the IMU It is used to measure the angular velocity information and acceleration information of the bracket, and the angular velocity information and acceleration information are used to control the equipment to determine the attitude angle information and position information of the bracket; Pushing displacement information combined with attitude angle information and position information is used for control equipment to determine the coordinate information of the target node on the scraper machine.
该种可能的实现方式中,可以通过IMU来测量支架的角速度信息和加速度信息,这样,控制设备就可以根据支架的角速度信息和加速度信息来确定支架的姿态角信息和位置信息,行程传感器可以测量支架的拉架位移信息和推溜位移信息,这样,控制设备就可以结合拉架位移信息、推溜位移信息、姿态角信息和位置信息确定刮板机上目标节点的坐标信息。本申请中,B个支架中每个支架上都设置有惯性测量单元IMU以及行程传感器,当B不等于A时,其他的支架上也可以设置有IMU或者/和行程传感器。In this possible implementation, the IMU can be used to measure the angular velocity information and acceleration information of the support, so that the control device can determine the attitude angle information and position information of the support according to the angular velocity information and acceleration information of the support, and the travel sensor can measure The frame displacement information and push displacement information of the support, so that the control device can determine the coordinate information of the target node on the scraper machine in combination with the frame displacement information, push displacement information, attitude angle information and position information. In this application, each of the B brackets is provided with an inertial measurement unit (IMU) and a travel sensor. When B is not equal to A, other brackets may also be provided with an IMU or/and a travel sensor.
在第一方面的一种可能的实现方式中,上述步骤:控制设备根据B个支架中每个支架的位置信息和姿态角信息,以及在调直方向上B个支架中每个支架对应的第一目标值,确定B个支架中每个支架的第一调节量,包括:控制设备确定B个支架中每个支架在调直方向上的位置信息,与B个支架中每个支架在调直方向上所对应的第一目标值的第一差值;控制设备将B个支架中每个支架的第一差值,与B个支架中每个支架在调直方向上的余弦数据的商确定为第一调节量;其中,余弦数据包括第一余弦,或者,第一余弦与第二余弦和第三余弦中至少一个的乘积,第一余弦为B个支架中每个支架在调直方向上的航向角的余弦,第二余弦为B个支架中每个支架在调直方向上的横滚角的余弦,第三余弦为B个支架中每个支架在调直方向上的俯仰角的余弦,航向角、横滚角、俯仰角包含于B个支架中每个支架的姿态角信息中。In a possible implementation of the first aspect, the above steps: the control device is based on the position information and attitude angle information of each bracket in the B brackets, and the first position corresponding to each bracket in the B brackets in the straightening direction. The target value is used to determine the first adjustment amount of each of the B brackets, including: the control device determines the position information of each of the B brackets in the straightening direction, and the position information of each of the B brackets in the straightening direction The first difference of the corresponding first target value; the control device determines the first difference between the first difference of each of the B brackets and the cosine data of each of the B brackets in the straightening direction as the first adjustment amount; wherein, the cosine data includes the first cosine, or the product of the first cosine and at least one of the second cosine and the third cosine, and the first cosine is the straightening direction of each bracket in the B brackets The cosine of the heading angle, the second cosine is the cosine of the roll angle of each bracket in the straightening direction of the B brackets, and the third cosine is the cosine of the pitch angle of each bracket in the straightening direction of the B brackets , the heading angle, roll angle, and pitch angle are included in the attitude angle information of each bracket in the B brackets.
该种可能的实现方式中,第一差值为第一目标值与支架在调直方向上的坐标值的差值,该差值可以是正值或负值,正值表示与调直方向相同,负值表示与调直方向相反。以调直方向是y轴为例,一个支架的坐标为(Xn,Yn,Zn),姿态信息为(θnx,θny,θnz),其中,θny为航向角,θnx为俯仰角,θnz为横滚角,对应的第一目标值为Fn,则第一差值=Fn-Yn。第一调节量=(Fn-Yn)/余弦数据,第一余弦=cosθny,第二余弦=cosθnz,第三余弦=cosθnx,余弦数据可以是cosθny,也可以是cosθny.cosθnz,cosθny.cosθnx或者cosθny.cosθnz.cosθnx。其中,“.”表示乘号。本申请在计算第一调节量时考虑到了支架可能会受影响的各种角度因素,这样计算出来的第一调节量更精准,进一步提高了支架阵列调直的精准度。In this possible implementation, the first difference is the difference between the first target value and the coordinate value of the bracket in the straightening direction, and the difference can be a positive or negative value, and a positive value means that it is the same as the straightening direction, Negative values indicate the opposite direction of straightening. Taking the straightening direction as the y-axis as an example, the coordinates of a bracket are (Xn, Yn, Zn), and the attitude information is (θnx, θny, θnz), where θny is the heading angle, θnx is the pitch angle, and θnz is the roll angle, and the corresponding first target value is Fn, then the first difference=Fn-Yn. The first adjustment value=(Fn-Yn)/cosine data, the first cosine=cosθny, the second cosine=cosθnz, the third cosine=cosθnx, the cosine data can be cosθny or cosθny.cosθnz, cosθny. cosθnx or cosθny.cosθnz.cosθnx. Among them, "." represents the multiplication sign. When calculating the first adjustment amount, the present application takes into account various angle factors that may be affected by the bracket, so that the calculated first adjustment amount is more accurate, and further improves the alignment accuracy of the bracket array.
在第一方面的一种可能的实现方式中,该方法还包括:控制设备根据B个支架中每个支架的位置信息,确定第一曲线,第一曲线用于描述B个支架的位置分布;若第一曲线中在调 直方向上的最大波峰值或者最大波谷值超出第一阈值,或者在调直方向上最大波峰值与最大波谷值的差值超出第二阈值,则控制设备执行确定第一调节量的步骤。In a possible implementation manner of the first aspect, the method further includes: the control device determines a first curve according to the position information of each of the B brackets, and the first curve is used to describe the position distribution of the B brackets; If the maximum peak value or the maximum valley value in the straightening direction in the first curve exceeds the first threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the second threshold, the control device performs a determination of the first adjustment Quantitative steps.
该种可能的实现方式中,第一曲线可以是B个支架中每个支架的坐标的连线,也可以是对B个支架中每个支架的坐标做拟合处理后得到的曲线。该第一曲线可以描述B个支架的位置分布。第一阈值和第二阈值可以是预配置的值,如:1厘米到50厘米,或者其他数值,如果第一曲线中在调直方向上的最大波峰值或者最大波谷值未超出第一阈值,或者在调直方向上的最大波峰值与最大波谷值的差值未超出第二阈值,则表示当前支架阵列比较直,不需要执行调直处理,可以节省用于调直的时间,从而提高工作效率。In this possible implementation manner, the first curve may be a line connecting the coordinates of each of the B brackets, or may be a curve obtained by fitting the coordinates of each of the B brackets. The first curve may describe the position distribution of the B brackets. The first threshold and the second threshold may be preconfigured values, such as: 1 cm to 50 cm, or other values, if the maximum peak value or the maximum valley value in the straightening direction in the first curve does not exceed the first threshold value, or The difference between the maximum peak value and the maximum valley value in the straightening direction does not exceed the second threshold, which means that the current support array is relatively straight, and no straightening processing is required, which saves time for straightening and improves work efficiency.
在第一方面的一种可能的实现方式中,上述步骤:控制设备根据B个支架中每个支架的位置信息和姿态角信息、B个支架中每个支架的推杆伸出的长度值,以及在调直方向上每个目标节点所对应的第二目标值,确定每个目标节点的第二调节量,包括:控制设备根据B个支架中每个支架的位置信息,以及B个支架中每个支架的推杆伸出的长度值,以及B个支架中每个支架的姿态角信息,确定每个目标节点的坐标信息;控制设备确定每个目标节点的在调直方向上的坐标信息,与在调直方向上每个目标节点所对应的第二目标值的第二差值;控制设备将每个目标节点所对应的第二差值,与每个目标节点在调直方向上的余弦数据的商确定为第二调节量;其中,余弦数据包括第四余弦,或者,第四余弦与第五余弦和第六余弦中至少一个的乘积,第四余弦为每个目标节点所连接的推杆在调直方向上的航向角的余弦,第五余弦为每个目标节点所连接的推杆在调直方向上的横滚角的余弦,第六余弦为每个目标节点所连接的推杆在调直方向上的俯仰角的余弦,航向角、横滚角、俯仰角包含于每个目标节点所连接的推杆的姿态角信息中,每个目标节点所连接的推杆的姿态角信息为推杆所在的支架的姿态角信息。In a possible implementation of the first aspect, the above steps: the control device, according to the position information and attitude angle information of each bracket in the B brackets, and the length value of the push rod of each bracket in the B brackets, As well as the second target value corresponding to each target node in the straightening direction, determining the second adjustment amount of each target node includes: the control device is based on the position information of each bracket in the B brackets, and the position information of each bracket in the B brackets The extended length value of the push rod of the B brackets, and the attitude angle information of each bracket in the B brackets, determine the coordinate information of each target node; the control device determines the coordinate information of each target node in the straightening direction, and The second difference of the second target value corresponding to each target node in the straightening direction; the control device calculates the quotient of the second difference corresponding to each target node and the cosine data of each target node in the straightening direction Determined as the second adjustment amount; wherein, the cosine data includes the fourth cosine, or the product of the fourth cosine and at least one of the fifth cosine and the sixth cosine, and the fourth cosine is connected to each target node The cosine of the heading angle of the push rod in the straightening direction, the fifth cosine is the cosine of the roll angle of the push rod connected to each target node in the straightening direction, and the sixth cosine is the cosine of the roll angle of the push rod connected to each target node The cosine of the pitch angle of the push rod in the straightening direction, the heading angle, roll angle, and pitch angle are included in the attitude angle information of the push rod connected to each target node, and the attitude angle of the push rod connected to each target node The information is the attitude angle information of the bracket where the push rod is located.
该种可能的实现方式中,一个支架的坐标为(Xn,Yn,Zn),姿态信息为(θnx,θny,θnz),推杆伸出的长度值为dn,对应目标节点的坐标信息为(an、bn、cn),以在y轴方向上为例,bn=Yn+dn/cosθny,第二差值为第二目标值En与bn的差值(En-bn)。第二调节量=(En-bn)/余弦数据,第四余弦=cosθny,第五余弦=cosθnz,第六余弦=cosθnx,余弦数据可以是cosθny,也可以是cosθny.cosθnz,cosθny.cosθnx或者cosθny.cosθnz.cosθnx。本申请在计算第二调节量时考虑到了推杆可能会受影响的各种角度因素,这样计算出来的第二调节量更精准,进一步提高了刮板机调直的精准度。In this possible implementation, the coordinates of a bracket are (Xn, Yn, Zn), the attitude information is (θnx, θny, θnz), the length of the push rod is dn, and the coordinate information of the corresponding target node is ( an, bn, cn), taking the y-axis direction as an example, bn=Yn+dn/cosθny, the second difference is the difference (En−bn) between the second target value En and bn. The second adjustment amount=(En-bn)/cosine data, the fourth cosine=cosθny, the fifth cosine=cosθnz, the sixth cosine=cosθnx, the cosine data can be cosθny, or cosθny.cosθnz, cosθny. cosθnx or cosθny.cosθnz.cosθnx. The present application takes into account various angle factors that may be affected by the push rod when calculating the second adjustment amount, so that the calculated second adjustment amount is more accurate, and further improves the straightening accuracy of the scraper machine.
在第一方面的一种可能的实现方式中,该方法还包括:控制设备根据每个目标节点的坐标信息,确定第二曲线,第二曲线用于描述每个目标节点的位置分布;若第二曲线中在调直方向上的最大波峰值或者最大波谷值超出第三阈值,或者在调直方向上的最大波峰值与最大波谷值的差值超出第四阈值,则控制设备执行确定第二调节量的步骤。In a possible implementation manner of the first aspect, the method further includes: the control device determines a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node; if the first In the second curve, the maximum peak value or the maximum valley value in the straightening direction exceeds the third threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the fourth threshold, then the control device performs determination of the second adjustment amount A step of.
该种可能的实现方式中,第二曲线可以是每个目标节点在调直方向上的坐标的连线,也可以是对每个目标节点在调直方向上的坐标做拟合处理后得到的曲线。该第二曲线可以描述每个目标节点的位置分布。第三阈值和第四阈值可以是预配置的值,如:1厘米到50厘米,或者其他数值,如果第二曲线中的最大波峰值或者最大波谷值未超出第三阈值,或者在调直方向上的最大波峰值与最大波谷值的差值未超出第四阈值,则表示当前刮板机比 较直,不需要执行调直处理,可以节省用于调直的时间,从而提高采煤机的工作效率。In this possible implementation manner, the second curve may be a line connecting the coordinates of each target node in the straightening direction, or may be a curve obtained by fitting the coordinates of each target node in the straightening direction. The second curve may describe the position distribution of each target node. The third threshold and the fourth threshold can be pre-configured values, such as: 1 cm to 50 cm, or other values, if the maximum peak or maximum valley value in the second curve does not exceed the third threshold, or in the straightening direction The difference between the maximum peak value and the maximum valley value does not exceed the fourth threshold, which means that the current scraper is relatively straight and does not need to be straightened, which can save time for straightening and improve the working efficiency of the shearer .
在第一方面的一种可能的实现方式中,该方法还包括:控制设备根据B个支架中每个支架在调直方向上的航向角的测量值,以及在调直方向上的航向角的目标值,确定B个支架中每个支架的航向角的补偿值;控制设备向B个支架中每个支架的相邻支架发送对应航向角的补偿值,航向角的补偿值用于相邻支架调整B个支架中每个支架位置,以将B个支架中每个支架调整到航向角的目标值。In a possible implementation of the first aspect, the method further includes: the control device according to the measured value of the heading angle of each bracket in the straightening direction in the B brackets, and the target value of the heading angle in the straightening direction , to determine the compensation value of the heading angle of each bracket in the B brackets; the control device sends the compensation value of the corresponding heading angle to the adjacent brackets of each bracket in the B brackets, and the compensation value of the heading angle is used for the adjacent brackets to adjust B The position of each bracket in the B brackets, so as to adjust each bracket in the B brackets to the target value of the heading angle.
该种可能的实现方式中,支架阵列中相邻的两个支架可以通过两侧的驱动机构来推动另一个支架旋转一定的角度,如:调直方向是y轴方向,则可以通过x轴方向的推杆来推动相邻的支架旋转,从而调正支架阵列中发生角度旋转的支架。需要说明的是,该种可能的实现方式中的航向角的补偿值包括角度的补偿值和推动相邻支架的推杆的推移补偿值,如果平行于煤面的方向是x轴,推动相邻支架的推杆通常指的是x轴方向上的推杆。其中,角度的补偿值可以是航向角的目标值与航向角的测量值的差值,推杆的推移补偿值可以是根据支架的底板在Y轴方向的长度以及角度的补偿值来确定调正支架在x轴方向上需要推移的距离。In this possible implementation, two adjacent brackets in the bracket array can push the other bracket to rotate by a certain angle through the driving mechanisms on both sides. For example, if the straightening direction is the y-axis direction, then the x-axis direction can The push rod of the stent is used to push the adjacent stent to rotate, so as to adjust the angular rotation of the stent in the stent array. It should be noted that the compensation value of the heading angle in this possible implementation includes the compensation value of the angle and the displacement compensation value of the push rod that pushes the adjacent support. If the direction parallel to the coal surface is the x-axis, push the adjacent The push rod of the bracket usually refers to the push rod in the x-axis direction. Wherein, the compensation value of the angle can be the difference between the target value of the heading angle and the measured value of the heading angle, and the pushing compensation value of the push rod can be determined according to the length of the bottom plate of the bracket in the Y-axis direction and the compensation value of the angle. The distance that the bracket needs to move in the x-axis direction.
本申请第二方面提供一种综采面系统中的支架,该支架上设置有惯性测量单元IMU以及行程传感器,行程传感器设置于支架的推杆的驱动机构上;IMU用于测量支架的角速度信息和加速度信息,角速度信息和加速度信息用于控制设备确定支架的姿态角信息和位置信息;行程传感器用于测量支架的拉架位移信息和推溜位移信息,拉架位移信息和推溜位移信息结合姿态角信息和位置信息用于综采面系统中的控制设备确定综采面系统中刮板机上目标节点的坐标信息,目标节点为支架的推杆与刮板机的连接点。The second aspect of the application provides a support in the fully mechanized mining face system, the support is provided with an inertial measurement unit IMU and a travel sensor, the travel sensor is arranged on the drive mechanism of the push rod of the support; the IMU is used to measure the angular velocity information of the support And acceleration information, angular velocity information and acceleration information are used to control the equipment to determine the attitude angle information and position information of the bracket; the stroke sensor is used to measure the frame displacement information and push displacement information of the bracket, and the frame displacement information and push displacement information are combined with the attitude angle The information and position information are used for the control equipment in the fully mechanized mining face system to determine the coordinate information of the target node on the scraper machine in the fully mechanized mining face system. The target node is the connection point between the push rod of the support and the scraper machine.
第二方面中,可以通过IMU来测量支架的角速度信息和加速度信息,这样,控制设备就可以根据支架的角速度信息和加速度信息来确定支架的姿态角信息和位置信息,行程传感器可以测量支架的拉架位移信息和推溜位移信息,这样,控制设备就可以结合拉架位移信息、推溜位移信息、姿态角信息和位置信息确定刮板机上目标节点的坐标信息。这样控制设备就可以根据支架的姿态角信息和位置信息,以及刮板机上目标节点的坐标信息进行支架阵列的调直和刮板机的调直。In the second aspect, the angular velocity information and acceleration information of the support can be measured through the IMU, so that the control device can determine the attitude angle information and position information of the support according to the angular velocity information and acceleration information of the support, and the travel sensor can measure the frame of the support Displacement information and push displacement information, so that the control device can determine the coordinate information of the target node on the scraper machine by combining the frame displacement information, push displacement information, attitude angle information and position information. In this way, the control device can adjust the bracket array and the scraper machine according to the attitude angle information and position information of the bracket, and the coordinate information of the target node on the scraper machine.
在第二方面的一种可能的实现方式中,综采面系统包括支架阵列,该支架为支架阵列中的一个;支架的姿态角信息和位置信息用于控制设备结合支架的第一目标值确定支架的第一调节量,第一调节量用于支架进行拉架移动,以调直支架阵列;目标节点的坐标信息用于控制设备结合目标节点的第二目标值,确定目标节点的第二调节量,第二调节量用于目标节点所连接的推杆进行推溜,以调直刮板机。In a possible implementation of the second aspect, the fully mechanized mining face system includes a support array, and the support is one of the support arrays; the attitude angle information and position information of the support are used for the control equipment to determine the first target value of the support in conjunction with The first adjustment amount of the bracket, the first adjustment amount is used to move the bracket to straighten the bracket array; the coordinate information of the target node is used to control the device combined with the second target value of the target node to determine the second adjustment amount of the target node , the second adjustment amount is used to push the push rod connected to the target node to straighten the scraper.
在第二方面的一种可能的实现方式中,支架为液压支架、气动支架或电动支架。In a possible implementation manner of the second aspect, the support is a hydraulic support, a pneumatic support or an electric support.
在第二方面的一种可能的实现方式中,IMU设置于支架的底座或顶梁上。In a possible implementation manner of the second aspect, the IMU is disposed on a base or a top beam of the bracket.
在第二方面的一种可能的实现方式中,IMU的一个轴的方向与行程传感器的朝向相同。如行程传感器的朝向与IMU的y轴方向相同,当然,行程传感器也可以与y轴之间有夹角,如果有夹角,在计算目标节点的坐标时,则需要考虑行程传感器也可以与y轴之间有夹角。In a possible implementation manner of the second aspect, the direction of one axis of the IMU is the same as the orientation of the stroke sensor. If the orientation of the stroke sensor is the same as the y-axis direction of the IMU, of course, the stroke sensor can also have an angle with the y-axis. If there is an angle, when calculating the coordinates of the target node, it needs to be considered that the stroke sensor can also be in the same direction as the y-axis. There is an angle between the axes.
以上,第二方面或第二方面的任一种可能的实现方式中的一些特征及效果可以参考第 一方面中的特征和效果进行理解,此处不再过多赘述。Above, some features and effects of the second aspect or any possible implementation of the second aspect can be understood with reference to the features and effects of the first aspect, and will not be repeated here.
本申请第三方面提供一种用于调直多节点设备的控制设备,该控制设备包含于综采面系统,综采面系统还包括支架阵列和刮板机,支架阵列包括A个支架,其中,A个支架中的每个支架都通过推杆与刮板机连接,A为大于1的整数,该控制设备包括:The third aspect of the present application provides a control device for straightening multi-node equipment. The control device is included in the fully mechanized mining face system. The fully mechanized mining face system also includes a bracket array and a scraper machine. The bracket array includes A brackets, wherein , each of the A brackets is connected to the scraper machine through a push rod, A is an integer greater than 1, and the control equipment includes:
获取单元,用于获取支架阵列中B个支架的位置信息和姿态角信息,B=A,或者,B个支架间隔分布在A个支架中,B为正整数。The acquiring unit is used to acquire the position information and the attitude angle information of the B brackets in the bracket array, B=A, or, the B brackets are distributed among the A brackets at intervals, and B is a positive integer.
处理单元,用于根据获取单元获取的B个支架中每个支架的位置信息和姿态角信息,以及在调直方向上B个支架中每个支架对应的第一目标值,确定B个支架中每个支架的第一调节量,和/或,根据B个支架中每个支架的位置信息和姿态角信息、B个支架中每个支架的推杆伸出的长度值,以及在调直方向上每个目标节点所对应的第二目标值,确定每个目标节点的第二调节量,目标节点为B个支架中每个支架的推杆与刮板机的连接点。The processing unit is used to determine the position information and attitude angle information of each bracket in the B brackets obtained by the acquisition unit, and the first target value corresponding to each bracket in the B brackets in the straightening direction, and determine the position information of each bracket in the B brackets. The first adjustment amount of the first bracket, and/or, according to the position information and attitude angle information of each bracket in the B brackets, the length value of the push rod of each bracket in the B brackets, and each bracket in the straightening direction The second target value corresponding to the target nodes determines the second adjustment value of each target node, and the target node is the connection point between the push rod of each bracket in the B brackets and the scraper machine.
发送单元,用于向B个支架中每个支架发送对应的处理单元确定的第一调节量和/或第二调节量,第一调节量用于B个支架中每个支架在调直方向上进行拉架移动,以调直支架阵列,第二调节量用于每个目标节点所连接的推杆进行推溜,以调直刮板机。The sending unit is configured to send the first adjustment amount and/or the second adjustment amount determined by the corresponding processing unit to each of the B brackets, and the first adjustment amount is used for each bracket of the B brackets to perform adjustment in the straightening direction. The pull frame moves to straighten the bracket array, and the second adjustment amount is used to push the push rod connected to each target node to straighten the scraper.
在第三方面的一种可能的实现方式中,B个支架中每个支架上都设置有惯性测量单元IMU以及行程传感器,行程传感器设置于推杆的驱动机构上;IMU用于测量支架的角速度信息和加速度信息,角速度信息和加速度信息用于控制设备确定支架的姿态角信息和位置信息;行程传感器用于测量支架的拉架位移信息和推溜位移信息,拉架位移信息和推溜位移信息结合姿态角信息和位置信息用于控制设备确定刮板机上目标节点的坐标信息。In a possible implementation of the third aspect, each of the B brackets is provided with an inertial measurement unit IMU and a stroke sensor, and the stroke sensor is arranged on the drive mechanism of the push rod; the IMU is used to measure the angular velocity of the bracket Information and acceleration information, angular velocity information and acceleration information are used to control the equipment to determine the attitude angle information and position information of the bracket; the travel sensor is used to measure the frame displacement information and push displacement information of the bracket, and the frame displacement information and push displacement information are combined with attitude The angle information and position information are used for the control equipment to determine the coordinate information of the target node on the scraper machine.
在第三方面的一种可能的实现方式中,处理单元用于:确定B个支架中每个支架在调直方向上的位置信息,与B个支架中每个支架在调直方向上所对应的第一目标值的第一差值;将B个支架中每个支架的第一差值,与B个支架中每个支架在调直方向上的余弦数据的商确定为第一调节量;其中,余弦数据包括第一余弦,或者,第一余弦与第二余弦和第三余弦中至少一个的乘积,第一余弦为B个支架中每个支架在调直方向上的航向角的余弦,第二余弦为B个支架中每个支架在调直方向上的横滚角的余弦,第三余弦为B个支架中每个支架在调直方向上的俯仰角的余弦,航向角、横滚角,俯仰角包含于B个支架中每个支架的姿态角信息中。In a possible implementation of the third aspect, the processing unit is configured to: determine the position information of each bracket in the straightening direction of the B brackets, and the position information corresponding to the straightening direction of each bracket in the B brackets The first difference of a target value; the first difference of each bracket in the B brackets, and the quotient of the cosine data of each bracket in the straightening direction in the B brackets are determined as the first adjustment amount; wherein, the cosine The data includes the first cosine, or the product of the first cosine and at least one of the second cosine and the third cosine, and the first cosine is the cosine of the heading angle of each of the B supports in the straightening direction , the second cosine is the cosine of the roll angle of each of the B brackets in the straightening direction, the third cosine is the cosine of the pitch angle of each of the B brackets in the straightening direction, the heading angle, roll angle The roll angle and the pitch angle are included in the attitude angle information of each bracket in the B brackets.
在第三方面的一种可能的实现方式中,处理单元还用于:根据B个支架中每个支架的位置信息,确定第一曲线,第一曲线用于描述B个支架的位置分布;若第一曲线中在调直方向上的最大波峰值或者最大波谷值超出第一阈值,或者在调直方向上的最大波峰值与最大波谷值的差值超出第二阈值,则执行确定第一调节量的步骤。In a possible implementation of the third aspect, the processing unit is further configured to: determine a first curve according to the position information of each of the B brackets, where the first curve is used to describe the position distribution of the B brackets; if In the first curve, the maximum peak value or the maximum valley value in the straightening direction exceeds the first threshold value, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the second threshold value, then the determination of the first adjustment amount is performed. step.
在第三方面的一种可能的实现方式中,处理单元用于:根据B个支架中每个支架的位置信息,以及B个支架中每个支架的推杆伸出的长度值,以及B个支架中每个支架的姿态角信息,确定每个目标节点的坐标信息;确定每个目标节点的在调直方向上的坐标信息,与在调直方向上每个目标节点所对应的第二目标值的第二差值;将每个目标节点所对应的第二差值,与每个目标节点在调直方向上的余弦数据的商确定为第二调节量;其中,余弦数据包括第四余弦,或者,第四余弦与第五余弦和第六余弦中至少一个的乘积,第四余弦为每 个目标节点所连接的推杆在调直方向上的航向角的余弦,第五余弦为每个目标节点所连接的推杆在调直方向上的横滚角的余弦,第六余弦为每个目标节点所连接的推杆在调直方向上的俯仰角的余弦,航向角、横滚角,俯仰角包含于每个目标节点所连接的推杆的姿态角信息中,每个目标节点所连接的推杆的姿态角信息为推杆所在的支架的姿态角信息。In a possible implementation of the third aspect, the processing unit is configured to: according to the position information of each bracket in the B brackets, and the length value of the push rod of each bracket in the B brackets, and the B brackets The attitude angle information of each bracket in the bracket determines the coordinate information of each target node; determines the coordinate information of each target node in the straightening direction, and the second target value corresponding to each target node in the straightening direction The second difference; the quotient of the second difference corresponding to each target node and the cosine data of each target node in the straightening direction is determined as the second adjustment amount; wherein the cosine data includes the fourth cosine, or , the product of the fourth cosine and at least one of the fifth cosine and the sixth cosine, the fourth cosine is the cosine of the heading angle of the push rod connected to each target node in the straightening direction, and the fifth cosine is The cosine of the roll angle of the push rod connected to each target node in the straightening direction, the sixth cosine is the cosine of the pitch angle of the push rod connected to each target node in the straightening direction, heading angle, roll angle , the pitch angle is included in the attitude angle information of the push rod connected to each target node, and the attitude angle information of the push rod connected to each target node is the attitude angle information of the bracket where the push rod is located.
在第三方面的一种可能的实现方式中,处理单元还用于:根据每个目标节点的坐标信息,确定第二曲线,第二曲线用于描述每个目标节点的位置分布;若第二曲线中在调直方向上的最大波峰值或者最大波谷值超出第三阈值,或者在调直方向上的最大波峰值与最大波谷值的差值超出第四阈值,则执行确定第二调节量的步骤。In a possible implementation of the third aspect, the processing unit is further configured to: determine a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node; if the second If the maximum peak value or the maximum valley value in the straightening direction of the curve exceeds the third threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the fourth threshold, the step of determining the second adjustment amount is executed.
在第三方面的一种可能的实现方式中,处理单元还用于:根据B个支架中每个支架在调直方向上的航向角的测量值,以及在调直方向上的航向角的目标值,确定B个支架中每个支架的航向角的补偿值。In a possible implementation manner of the third aspect, the processing unit is further configured to: according to the measured value of the heading angle of each of the B brackets in the straightening direction and the target value of the heading angle in the straightening direction, Determine the compensation value for the heading angle of each of the B brackets.
发送单元,还用于向B个支架中每个支架的相邻支架发送对应航向角的补偿值,航向角的补偿值用于相邻支架调整B个支架中每个支架位置,以将B个支架中每个支架调整到航向角的目标值。The sending unit is also used to send the compensation value of the corresponding heading angle to the adjacent brackets of each bracket in the B brackets, and the compensation value of the heading angle is used for the adjacent brackets to adjust the position of each bracket in the B brackets, so that the B brackets Each bracket in the bracket is adjusted to the target value of the heading angle.
该控制设备具有实现上述第一方面或第一方面任意一种可能实现方式的方法的功能。该功能可以通过硬件实现,也可以通过硬件执行相应的软件实现。该硬件或软件包括一个或多个与上述功能相对应的模块,例如上述:获取单元、处理单元和发送单元。该第三方面或第三方面任一种可能的实现方式的相关内容可以参阅第一方面及第一方面任一种可能的实现方式的相关内容进行理解。The control device has the function of implementing the first aspect or the method of any possible implementation manner of the first aspect. This function may be implemented by hardware, or may be implemented by executing corresponding software on the hardware. The hardware or software includes one or more modules corresponding to the above functions, such as the above: acquisition unit, processing unit and sending unit. The relevant content of the third aspect or any possible implementation manner of the third aspect may be understood by referring to the first aspect and the relevant content of any possible implementation manner of the first aspect.
本申请第四方面提供一种控制设备,该控制设备包括至少一个处理器、存储器、输入/输出(input/output,I/O)接口以及存储在存储器中并可在处理器上运行的计算机执行指令,当计算机执行指令被处理器执行时,处理器执行如上述第一方面或第一方面任意一种可能的实现方式的方法。The fourth aspect of the present application provides a control device, the control device includes at least one processor, a memory, an input/output (input/output, I/O) interface, and a computer executable stored in the memory and operable on the processor Instructions, when the computer-executed instructions are executed by the processor, the processor executes the method according to the above first aspect or any possible implementation manner of the first aspect.
本申请第五方面提供一种存储一个或多个计算机执行指令的计算机可读存储介质,当计算机执行指令被处理器执行时,一个或多个处理器执行如上述第一方面或第一方面任意一种可能的实现方式的方法。The fifth aspect of the present application provides a computer-readable storage medium storing one or more computer-executable instructions. When the computer-executable instructions are executed by a processor, the one or more processors execute any of the above-mentioned first aspect or first aspect. A method of one possible implementation.
本申请第六方面提供一种存储一个或多个计算机执行指令的计算机程序产品,当计算机执行指令被一个或多个处理器执行时,一个或多个处理器执行如上述第一方面或第一方面任意一种可能的实现方式的方法。The sixth aspect of the present application provides a computer program product that stores one or more computer-executable instructions. When the computer-executable instructions are executed by one or more processors, one or more processors execute the above-mentioned first aspect or first A method for any one of the possible implementations of the aspect.
本申请第七方面提供了一种芯片系统,该芯片系统包括至少一个处理器,至少一个处理器用于支持控制设备实现上述第一方面或第一方面任意一种可能的实现方式中所涉及的功能。在一种可能的设计中,芯片系统还可以包括存储器,存储器,用于保存控制设备必要的程序指令和数据。该芯片系统,可以由芯片构成,也可以包含芯片和其他分立器件。The seventh aspect of the present application provides a chip system, the chip system includes at least one processor, at least one processor is used to support the control device to implement the functions involved in the first aspect or any possible implementation of the first aspect . In a possible design, the system-on-a-chip may further include a memory, and the memory is used to store necessary program instructions and data for controlling the device. The system-on-a-chip may consist of chips, or may include chips and other discrete devices.
本申请第八方面提供一种综采面系统,包括支架阵列、刮板机、采煤机和控制设备,支架阵列包括A个支架,其中,A个支架中的每个支架都通过推杆与刮板机连接,采煤机在刮板机上运行,A为大于1的整数,控制设备用于执行上述第一方面或第一方面任意一种可能的实现方式的方法。The eighth aspect of the present application provides a fully mechanized mining face system, including a support array, a scraper machine, a coal shearer and control equipment. The support array includes A supports, wherein, each support in the A supports is connected to each other through a push rod. The scraper machine is connected, the coal shearer runs on the scraper machine, A is an integer greater than 1, and the control device is used to implement the method of the first aspect or any one of the possible implementations of the first aspect.
附图说明Description of drawings
图1是本申请实施例提供的综采面系统的一结构示意图;Fig. 1 is a structural representation of the fully mechanized mining face system that the embodiment of the application provides;
图2是本申请实施例提供的综采面系统的另一结构示意图;Fig. 2 is another schematic structural view of the fully mechanized mining face system provided by the embodiment of the present application;
图3是本申请实施例提供的多个节点设备的调直方法的一实施例示意图;Fig. 3 is a schematic diagram of an embodiment of a method for straightening multiple node devices provided by an embodiment of the present application;
图4A是本申请实施例提供的支架的一结构示意图;Fig. 4A is a schematic structural view of the bracket provided by the embodiment of the present application;
图4B是本申请实施例提供的支架的另一结构示意图;Fig. 4B is another structural schematic diagram of the stent provided by the embodiment of the present application;
图5是本申请实施例提供的多个节点设备的调直方法的另一实施例示意图;Fig. 5 is a schematic diagram of another embodiment of a method for aligning multiple node devices provided by the embodiment of the present application;
图6A是本申请实施例提供的三维坐标系的一示意图;Fig. 6A is a schematic diagram of the three-dimensional coordinate system provided by the embodiment of the present application;
图6B是本申请实施例提供的三维坐标系的另一示意图;Fig. 6B is another schematic diagram of the three-dimensional coordinate system provided by the embodiment of the present application;
图7A是本申请实施例提供的第一曲线的一示例示意图;Fig. 7A is a schematic diagram of an example of the first curve provided by the embodiment of the present application;
图7B是本申请实施例提供的计算第一差值的一示例示意图;Fig. 7B is a schematic diagram of an example of calculating the first difference provided by the embodiment of the present application;
图8A是本申请实施例提供的多个节点设备的调直方法的一示例示意图;FIG. 8A is a schematic diagram of an example of an alignment method for multiple node devices provided by an embodiment of the present application;
图8B是本申请实施例提供的多个节点设备的调直方法的另一示例示意图;FIG. 8B is a schematic diagram of another example of a method for straightening multiple node devices provided by an embodiment of the present application;
图8C是本申请实施例提供的多个节点设备的调直方法的另一示例示意图;Fig. 8C is another example schematic diagram of the method for straightening multiple node devices provided by the embodiment of the present application;
图8D是本申请实施例提供的多个节点设备的调直方法的另一示例示意图;FIG. 8D is a schematic diagram of another example of a method for straightening multiple node devices provided by an embodiment of the present application;
图9是本申请实施例提供的多个节点设备的调直方法的另一示例示意图;FIG. 9 is a schematic diagram of another example of an alignment method for multiple node devices provided by an embodiment of the present application;
图10是本申请实施例提供的控制设备的一结构示意图;FIG. 10 is a schematic structural diagram of a control device provided by an embodiment of the present application;
图11是本申请实施例提供的控制设备的另一结构示意图。Fig. 11 is another schematic structural diagram of the control device provided by the embodiment of the present application.
具体实施方式Detailed ways
下面结合附图,对本申请的实施例进行描述,显然,所描述的实施例仅仅是本申请一部分的实施例,而不是全部的实施例。本领域普通技术人员可知,随着技术发展和新场景的出现,本申请实施例提供的技术方案对于类似的技术问题,同样适用。Embodiments of the present application are described below in conjunction with the accompanying drawings. Apparently, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Those of ordinary skill in the art know that, with the development of technology and the emergence of new scenarios, the technical solutions provided in the embodiments of the present application are also applicable to similar technical problems.
本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的实施例能够以除了在这里图示或描述的内容以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。The terms "first", "second" and the like in the specification and claims of the present application and the above drawings are used to distinguish similar objects, and are not necessarily used to describe a specific sequence or sequence. It is to be understood that the terms so used are interchangeable under appropriate circumstances such that the embodiments described herein can be practiced in sequences other than those illustrated or described herein. Furthermore, the terms "comprising" and "having", as well as any variations thereof, are intended to cover a non-exclusive inclusion, for example, a process, method, system, product or device comprising a sequence of steps or elements is not necessarily limited to the expressly listed instead, may include other steps or elements not explicitly listed or inherent to the process, method, product or apparatus.
本申请提供了一种多节点设备的调直方法,用于自动调直综采面系统中的支架阵列和/或刮板机。本申请实施例还提供了相应的装置、设备、计算机可读存储介质,以及计算机程序产品等。以下分别进行详细说明。The present application provides a method for straightening multi-node equipment, which is used for automatically straightening support arrays and/or scrapers in a fully mechanized mining face system. Embodiments of the present application also provide corresponding devices, devices, computer-readable storage media, and computer program products. Each will be described in detail below.
煤矿井下的综采面系统的三机包括采煤机、支架阵列和刮板机,刮板机也称刮板运输机。支架阵列中的支架可以是液压支架、气动支架或电动支架。本申请实施例中以液压支架为例进行介绍。The three machines of the fully mechanized mining face system in the coal mine include a shearer, a support array and a scraper conveyor, and the scraper conveyor is also called a scraper conveyor. The supports in the support array may be hydraulic supports, pneumatic supports or electric supports. In the embodiment of the present application, a hydraulic support is taken as an example for introduction.
本申请实施例中综采面系统的结构可以参阅图1所示的综采面系统的一结构示意图进行理解。The structure of the fully mechanized mining face system in the embodiment of the present application can be understood by referring to a schematic structural diagram of the fully mechanized mining face system shown in FIG. 1 .
如图1所示,本申请实施例提供的综采面系统的三机包括采煤机101、液压支架102和刮板机103,刮板机也称刮板运输机。液压支架102可以有多个,在煤矿井下,支架阵列中的液压支架通常都几十个或者几百个。刮板机103相当于是采煤机101的轨道,采煤机101从刮板机103的一端走到另一端,完成一刀的采煤工作。然后液压支架102向与煤面垂直的方向移动,推动刮板机103也向煤面垂直的方向移动,采煤机101沿着刮板机103的的一端走到另一端,完成下一刀的采煤工作。As shown in Fig. 1, the three machines of the fully mechanized mining face system provided by the embodiment of the present application include a shearer 101, a hydraulic support 102 and a scraper conveyor 103, and the scraper conveyor is also called a scraper conveyor. There may be multiple hydraulic supports 102, and in coal mines, there are usually tens or hundreds of hydraulic supports in the support array. The scraper machine 103 is equivalent to the track of the coal shearer 101, and the coal shearer 101 walks from one end of the scraper machine 103 to the other end to complete a one-shot coal mining work. Then the hydraulic support 102 moves to the direction perpendicular to the coal face, and the scraper machine 103 is pushed to move also to the direction perpendicular to the coal face. coal work.
液压支架102的支架阵列如果不直,那么刮板机103的轨道大概率上也不直,这样采煤机101就无法切割出直的采煤面。所以支架阵列的调直以及刮板机的调直在综采面系统中非常重要。综采面系统中,不仅包括图1中示出的采煤机101、液压支架102和刮板机103,还包括其他设备,也包括通常设置于控制室中的控制设备。If the support array of the hydraulic support 102 is not straight, the track of the scraper machine 103 is probably not straight, so the coal shearer 101 cannot cut a straight coal face. Therefore, the straightening of the bracket array and the straightening of the scraper machine are very important in the fully mechanized mining face system. The fully mechanized mining face system includes not only the shearer 101, the hydraulic support 102, and the scraper machine 103 shown in Fig. 1, but also other equipment, including control equipment usually arranged in the control room.
如图2所示,控制设备与各支架通信连接,可以从支架获取支架的位置信息和姿态角信息,然后向支架发送控制信息,进而控制支架进行拉架移动或推溜。控制设备可以是计算机设备,在综采面系统中控制设备指的是控制综采面割煤三机工作的设备。本申请实施例中,“拉架移动”和“推溜”可以理解为是综采面系统中的常用语,拉架移动指的是支架降低顶梁后移动,推溜指的是推杆推拉刮板机,以实现刮板机前进或者后退。As shown in Figure 2, the control device communicates with each bracket, and can obtain the position information and attitude angle information of the bracket from the bracket, and then send control information to the bracket, and then control the bracket to move or push. The control equipment can be computer equipment. In the fully mechanized mining face system, the control equipment refers to the equipment that controls the work of the three coal cutting machines at the fully mechanized mining face. In the embodiment of the present application, "rack moving" and "pushing" can be understood as commonly used terms in the fully mechanized mining face system. The moving of the rack refers to the movement after the support lowers the top beam, and the pushing refers to the pushing and pulling of the scraper by the push rod. Machine, to realize the forward or backward of the scraper machine.
基于对支架阵列和/或刮板机进行调直的目的,本申请实施例提供一种多节点设备的调直方法,该方法应用于上述图2所示的综采面系统,综采面系统包括支架阵列、刮板机和控制设备,支架阵列包括A个支架,其中,A个支架中的每个支架都通过推杆与刮板机连接,A为大于1的整数。本申请实施例中,多节点设备指的是一起协同工作的多个设备,或者一个设备上有多个节点,多个节点一起协同工作。多节点设备可以是支架阵列,也可以是刮板机。支架阵列中包括多个支架,综采面系统中通常包括几十个或者几百个支架,每个支架都可以理解为是一个节点。刮板机通常是一条多个节点设备连接的轨道,与一个支架所连接的部分可以理解为是一个节点。Based on the purpose of straightening the bracket array and/or the scraper machine, the embodiment of the present application provides a method for straightening multi-node equipment, which is applied to the fully mechanized mining face system shown in Figure 2 above, and the fully mechanized mining face system It includes a bracket array, a scraper machine and a control device. The bracket array includes A brackets, wherein, each bracket in the A brackets is connected to the scraper machine through a push rod, and A is an integer greater than 1. In the embodiment of the present application, a multi-node device refers to multiple devices that work together, or a device has multiple nodes, and the multiple nodes work together. Multi-node devices can be rack arrays or scrapers. The support array includes multiple supports, and the fully mechanized mining face system usually includes dozens or hundreds of supports, and each support can be understood as a node. A scraper is usually a track connected to multiple node devices, and the part connected to a bracket can be understood as a node.
本申请实施例中,“调直”可以是调成一条直线,也可以不是调成绝对意义上的直线,误差允许的范围都可以理解为是调直。In the embodiment of the present application, "straightening" may mean adjusting to a straight line, or not adjusting to a straight line in an absolute sense, and the allowable range of error can be understood as straightening.
本申请实施例提供的调直方法的一实施例可以参阅图3进行理解,如图3所示,该调直方法的一实施例可以包括:An embodiment of the straightening method provided by the embodiment of the present application can be understood with reference to FIG. 3 . As shown in FIG. 3 , an embodiment of the straightening method may include:
201.控制设备获取支架阵列中B个支架的位置信息和姿态角信息。201. The control device acquires position information and attitude angle information of B brackets in the bracket array.
B=A,或者,B个支架间隔分布在A个支架中,B为正整数。B=A, or, B brackets are distributed among A brackets at intervals, and B is a positive integer.
B=A表示控制设备获取支架阵列中每个支架的位置信息和姿态角信息。B=A means that the control device obtains the position information and attitude angle information of each bracket in the bracket array.
B个支架间隔分布在A个支架指的是间隔几个支架获取一个支架的位置信息和姿态角信息。需要说明的是,间隔可以是均匀间隔,例如:每M个支架或者每隔(M-1)个支架获取一个支架的位置信息和姿态角信息。间隔也可以是不均匀间隔,例如:针对支架阵列中的支架,有的是间隔(M-1)个支架获取一个支架的位置信息和姿态角信息,有的是间隔P个支架获取一个支架的位置信息和姿态角信息,还可以有的是间隔Q个支架获取一个支架的位置信息和姿态角信息,具体的间隔方式本申请中不做限定。The distribution of the B brackets on the A brackets at intervals refers to obtaining the position information and attitude angle information of a bracket at intervals of several brackets. It should be noted that the interval may be a uniform interval, for example, acquiring position information and attitude angle information of a support every M supports or every (M−1) supports. The interval can also be uneven intervals, for example: for the supports in the support array, some obtain the position information and attitude angle information of a support at intervals of (M-1) supports, and some obtain the position information and attitude of a support at intervals of P supports For the angle information, it is also possible to obtain the position information and attitude angle information of a bracket at intervals of Q brackets, and the specific interval method is not limited in this application.
本申请中,位置包括3种平移自由度中的一种或多种平移自由度的信息。在其中一种 描述中,3种平移自由度包括x轴平移、y轴平移和z轴平移,当然,也可以包括其中一个轴或两个轴上的平移,如:x轴平移,x轴平移和y轴平移,实际上,也可以将一个轴或两个轴的平移理解为是一种特殊的三个轴的平移,只是另外的两个轴或一个轴上的平移量是0。姿态包括3种旋转自由度中的一种或多种旋转自由度的信息。在其中一种描述中,3种旋转自由度包括x轴旋转、y轴旋转和z轴旋转,当然,也可以包括其中一个轴或两个轴上的旋转,如:x轴旋转,x轴旋转和y轴旋转,实际上,也可以将一个轴或两个轴的旋转理解为是一种特殊的三个轴的旋转,只是另外的两个轴或一个轴上的旋转量是0。其中,平移自由度的信息可以是描述一个物体在坐标轴中的坐标信息,例如:每个支架的位置信息可以是每个支架在x轴、y轴、z轴中至少一个坐标轴上的坐标信息。旋转自由度的信息可以是描述一个物体绕坐标轴的旋转角度,如:航向角、横滚角或俯仰角,如,每个支架的姿态角信息可以包括每个支架的航向角信息、横滚角信息和俯仰角信息中的至少一个。In this application, the position includes information of one or more translational degrees of freedom among the three translational degrees of freedom. In one of the descriptions, the three translational degrees of freedom include x-axis translation, y-axis translation, and z-axis translation. Of course, translation on one or two axes can also be included, such as: x-axis translation, x-axis translation And y-axis translation, in fact, the translation of one axis or two axes can also be understood as a special three-axis translation, except that the translation amount on the other two axes or one axis is 0. The pose includes information on one or more of the three rotational degrees of freedom. In one of the descriptions, the three rotational degrees of freedom include x-axis rotation, y-axis rotation, and z-axis rotation. Of course, it can also include rotation on one or two axes, such as: x-axis rotation, x-axis rotation And y-axis rotation, in fact, the rotation of one axis or two axes can also be understood as a special three-axis rotation, except that the rotation amount on the other two axes or one axis is 0. Wherein, the information of the translation degree of freedom can be the coordinate information describing an object in the coordinate axis, for example: the position information of each support can be the coordinate of each support on at least one of the x-axis, y-axis and z-axis information. The information of the degree of freedom of rotation can describe the rotation angle of an object around the coordinate axis, such as: heading angle, roll angle or pitch angle, for example, the attitude angle information of each support can include the heading angle information of each support, roll angle At least one of angle information and pitch angle information.
202.控制设备根据B个支架中每个支架的位置信息和姿态角信息,以及在调直方向上B个支架中每个支架对应的第一目标值,确定B个支架中每个支架的第一调节量,和/或,根据B个支架中每个支架的位置信息和姿态角信息、B个支架中每个支架的推杆伸出的长度值,以及在调直方向上每个目标节点所对应的第二目标值,确定每个目标节点的第二调节量,目标节点为B个支架中每个支架的推杆与刮板机的连接点。202. The control device determines the first position of each bracket in the B brackets according to the position information and attitude angle information of each bracket in the B brackets, and the first target value corresponding to each bracket in the B brackets in the straightening direction. The adjustment amount, and/or, according to the position information and attitude angle information of each bracket in the B brackets, the length value of the push rod of each bracket in the B brackets, and the corresponding value of each target node in the straightening direction The second target value of is used to determine the second adjustment value of each target node, and the target node is the connection point between the push rod of each bracket in the B brackets and the scraper machine.
在调直方向上,B个支架中每个支架都会有一个对应的第一目标值,考虑到支架可能受到地面不平等原因干扰,控制设备会结合第一目标值和支架的姿态角信息来确定第一调节量,从而控制B个支架中每个支架都能拉架移动到相应第一目标值的位置,进而调直支架阵列。In the straightening direction, each of the B brackets will have a corresponding first target value. Considering that the bracket may be disturbed by ground inequality, the control device will combine the first target value and the attitude angle information of the bracket to determine the first target value. One adjustment amount, so that each of the B brackets can be controlled to move to a position corresponding to the first target value, and then the bracket array can be straightened.
目标节点是刮板机上与支架的推杆连接的节点,推杆的姿态角信息与支架的姿态角信息是相同的,推杆伸出的长度值表示的是从支架到目标节点的距离。在调直方向上,每个目标节点都会有一个对应的第二目标值,考虑到推杆可能受到地面不平等原因干扰,控制设备会结合第二目标值和支架的姿态角信息来确定第二调节量,从而控制B个支架中每个支架的推杆通过推溜,移动刮板机上的对应目标节点,进而调直刮板机。The target node is the node connected to the push rod of the support on the scraper machine. The attitude angle information of the push rod is the same as that of the support. The length value of the push rod represents the distance from the support to the target node. In the direction of straightening, each target node will have a corresponding second target value. Considering that the push rod may be disturbed by ground inequality, the control device will combine the second target value and the attitude angle information of the bracket to determine the second adjustment. Amount, so as to control the push rod of each bracket in the B brackets to move the corresponding target node on the scraper machine, and then straighten the scraper machine.
需要说明的是,第一目标值和第二目标值都为数值,第一目标值表示在调直方向上支架的调直目标,第二目标值表示在调直方向上刮板机的目标节点的调直目标。It should be noted that both the first target value and the second target value are numerical values, the first target value represents the straightening target of the bracket in the straightening direction, and the second target value represents the adjustment of the target node of the scraper machine in the straightening direction Straight target.
203.控制设备向B个支架中每个支架发送对应的第一调节量和/或第二调节量。203. The control device sends the corresponding first adjustment amount and/or the second adjustment amount to each of the B racks.
第一调节量用于B个支架中每个支架在调直方向上进行拉架移动,以调直支架阵列,第二调节量用于每个目标节点所连接的推杆进行推溜,以调直刮板机。The first adjustment amount is used for each bracket of the B brackets to move in the straightening direction to straighten the bracket array, and the second adjustment amount is used for pushing the push rod connected to each target node to straighten the scraper. trigger.
204.支架根据第一调节量进行拉架移动,以调直支架阵列,和/或,根据第二调节量进行推溜,以调直刮板机。204. The rack moves according to the first adjustment amount to straighten the rack array, and/or pushes and slides according to the second adjustment amount to straighten the scraper.
本申请实施例中,可以通过控制设备自动调直支架阵列和/或刮板机,实现了对支架阵列和/或刮板机调直的自动化,另外,本申请中,在调直支架阵列和/或刮板机时还充分考虑了支架的姿态角信息,提高了支架阵列和/或刮板机调直的精准度。In the embodiment of the present application, the automatic straightening of the support array and/or the scraper machine can be realized through the control equipment, and the automation of the straightening of the support array and/or the scraper machine is realized. In addition, in this application, in the straightening of the support array and The attitude angle information of the support is also fully considered during the /or scraper machine, which improves the alignment accuracy of the bracket array and/or the scraper machine.
上述步骤201获取支架阵列中B个支架的位置信息和姿态角信息的方式可以是从B个支架中每个支架上获取支架的角速度信息和加速度信息,然后控制设备根据角速度信息和 加速度信息确定支架的姿态角信息和位置信息,也可以是控制设备直接获取支架上的计算单元已经计算好的该支架的姿态角信息和位置信息。支架的角速度信息和加速度信息是支架上安装的惯性测量单元(inertial measurement unit,IMU)测量的。该支架上还安装有行程传感器,该行程传感器设置于推杆的驱动机构上,行程传感器用于测量支架的拉架位移信息和推溜位移信息,拉架位移信息和推溜位移信息结合姿态角信息和位置信息用于控制设备确定刮板机上目标节点的坐标信息。The method of obtaining the position information and attitude angle information of the B brackets in the bracket array in the above step 201 may be to obtain the angular velocity information and acceleration information of the brackets from each bracket in the B brackets, and then the control device determines the brackets according to the angular velocity information and acceleration information. The attitude angle information and position information of the support may also be obtained directly by the control device from the attitude angle information and position information of the support calculated by the calculation unit on the support. The angular velocity information and acceleration information of the bracket are measured by an inertial measurement unit (IMU) installed on the bracket. A stroke sensor is also installed on the bracket, and the stroke sensor is arranged on the driving mechanism of the push rod. The stroke sensor is used to measure the frame displacement information and the push displacement information of the support. The frame displacement information and the push displacement information are combined with the attitude angle information and The position information is used by the control device to determine the coordinate information of the target node on the scraper machine.
需要说明的是,B个支架中每个支架上都设置有惯性测量单元IMU以及行程传感器,当B不等于A时,其他的支架上也可以设置有IMU或者/和行程传感器。It should be noted that each of the B brackets is provided with an inertial measurement unit (IMU) and a travel sensor. When B is not equal to A, other brackets may also be provided with an IMU or/and a travel sensor.
由前述描述可知,本申请实施例还提供一种综采面系统中的支架,该支架上设置有惯性测量单元IMU以及行程传感器,行程传感器设置于支架的推杆的驱动机构上;IMU用于测量支架的角速度信息和加速度信息,角速度信息和加速度信息用于控制设备确定支架的姿态角信息和位置信息;行程传感器用于测量支架的拉架位移信息和推溜位移信息,拉架位移信息和推溜位移信息结合姿态角信息和位置信息用于综采面系统中的控制设备确定综采面系统中刮板机上目标节点的坐标信息,目标节点为支架的推杆与刮板机的连接点。As can be seen from the foregoing description, the embodiment of the present application also provides a support in a fully mechanized mining face system, the support is provided with an inertial measurement unit (IMU) and a travel sensor, and the travel sensor is provided on the drive mechanism of the push rod of the support; the IMU is used for Measure the angular velocity information and acceleration information of the support, and the angular velocity information and acceleration information are used to control the equipment to determine the attitude angle information and position information of the support; the stroke sensor is used to measure the frame displacement information and push displacement information of the support, and the frame displacement information and push displacement information Displacement information combined with attitude angle information and position information is used for the control equipment in the fully mechanized mining face system to determine the coordinate information of the target node on the scraper machine in the fully mechanized mining face system. The target node is the connection point between the push rod of the support and the scraper machine.
本申请实施例提供的支架阵列中支架的结构可以参阅图4A进行理解,如图4A所示,该支架包括底座301、后连杆302、掩护梁303、顶梁304、前连杆305、立柱306、推杆307、护帮板308、IMU309和行程传感器310。其中,后连杆302、前连杆305和立柱306的一端分别设置于底座301上,推杆307设置于底座的一个驱动机构上,需要说明的是,底座上可以设置有多个驱动机构,如:x轴方向的驱动机构,y轴方向的驱动机构,z轴方向的驱动机构,图4A中推杆307可以设置于y轴方向的驱动机构上,并且该推杆307的延伸方向与y轴方向的驱动机构的运动方向一致。行程传感器310也设置于y轴方向的驱动机构上,当然其他轴方向的驱动机构上也可以设置有行程传感器。该行程传感器310可以测量支架的拉架位移信息和推溜位移信息。后连杆302和前连杆305的另一端与掩护梁303连接,掩护梁303和立柱306的另一端与顶梁304连接,顶梁304的一端连接掩护梁303,中间位置连接立柱306,另一端连接护帮板308。在图4A中,IMU309安装于底座301上,实际上,如图4B所示,IMU309也可以安装于顶梁304上。The structure of the bracket in the bracket array provided by the embodiment of the present application can be understood with reference to FIG. 4A. As shown in FIG. 306 , push rod 307 , side guard 308 , IMU 309 and stroke sensor 310 . Wherein, one end of the rear connecting rod 302, the front connecting rod 305 and the column 306 is respectively arranged on the base 301, and the push rod 307 is arranged on a driving mechanism of the base. It should be noted that the base can be provided with multiple driving mechanisms, Such as: the drive mechanism in the x-axis direction, the drive mechanism in the y-axis direction, the drive mechanism in the z-axis direction, the push rod 307 in FIG. The direction of motion of the driving mechanism in the axial direction is consistent. The stroke sensor 310 is also disposed on the driving mechanism in the y-axis direction, and of course, the stroke sensor may also be disposed on the driving mechanism in other axis directions. The stroke sensor 310 can measure the rack displacement information and push displacement information of the support. The other end of the rear link 302 and the front link 305 is connected with the cover beam 303, the other end of the cover beam 303 and the column 306 is connected with the top beam 304, one end of the top beam 304 is connected with the cover beam 303, the middle position is connected with the column 306, and One end is connected to the side guard 308 . In FIG. 4A , the IMU 309 is installed on the base 301 . Actually, as shown in FIG. 4B , the IMU 309 can also be installed on the top beam 304 .
本申请实施例中,IMU的一个轴的方向与行程传感器的朝向相同。如行程传感器的朝向与IMU的y轴方向相同,当然,行程传感器也可以与y轴之间有夹角,如果有夹角,在计算目标节点的坐标时,则需要考虑行程传感器也可以与y轴之间有夹角。In the embodiment of the present application, the direction of one axis of the IMU is the same as the direction of the stroke sensor. If the orientation of the stroke sensor is the same as the y-axis direction of the IMU, of course, the stroke sensor can also have an angle with the y-axis. If there is an angle, when calculating the coordinates of the target node, it needs to be considered that the stroke sensor can also be in the same direction as the y-axis. There is an angle between the axes.
由前面描述可知,控制设备可以控制支架阵列中每个支架进行支架阵列的调直和/或刮板机的调直。也可以是控制设备控制支架阵列中间隔的支架进行,支架阵列的调直和/或刮板机的调直。下面分别进行介绍。It can be seen from the foregoing description that the control device can control each bracket in the bracket array to straighten the bracket array and/or straighten the scraper. It may also be that the control device controls the spaced supports in the support array to perform straightening of the support array and/or straightening of the scraper. Introduce them separately below.
一.控制设备控制支架阵列中每个支架进行支架阵列的调直和/或刮板机的调直。1. The control device controls each bracket in the bracket array to straighten the bracket array and/or straighten the scraper.
如图5所示,本申请实施例提供的多节点设备的调直方法的另一实施例包括:As shown in Figure 5, another embodiment of the method for straightening multi-node equipment provided by the embodiment of the present application includes:
401.控制设备从支架阵列中每个支架获取IMU测量的该支架的角速度信息和加速度信息,以及行程传感器测量的支架的拉架位移信息和推溜位移信息。401. The control device obtains the angular velocity information and acceleration information of the support measured by the IMU from each support in the support array, and the rack displacement information and push displacement information of the support measured by the travel sensor.
402.控制设备根据每个支架的角速度信息和加速度信息确定每个支架的位置信息和姿 态角信息。402. The control device determines the position information and attitude angle information of each support according to the angular velocity information and acceleration information of each support.
支架的位置信息可以是支架的三维坐标,以第n个支架为例,该第n个支架的三维坐标可以标记为(Xn,Yn,Zn)。支架的姿态角信息可以是支架在三维坐标系的上的俯仰角、航向角和横滚角,以第n个支架为例,该第n个支架的姿态角信息可以表示为(θnx,θny,θnz),其中,θnx为俯仰角,θny为航向角,θnz为横滚角。The position information of the bracket may be the three-dimensional coordinates of the bracket. Taking the nth bracket as an example, the three-dimensional coordinates of the nth bracket may be marked as (Xn, Yn, Zn). The attitude angle information of the support can be the pitch angle, heading angle and roll angle of the support on the three-dimensional coordinate system. Taking the n-th support as an example, the attitude angle information of the n-th support can be expressed as (θnx,θny, θnz), where θnx is the pitch angle, θny is the heading angle, and θnz is the roll angle.
本申请实施例中的三维坐标系可以参阅图6A进行理解,如图6A所示,平行于煤面的方向定义为x轴,垂直于煤面的方向定义为y轴,与x轴和y轴的平面垂直的方向定义为z轴。其中,θx为俯仰角,表示绕y轴与x轴的夹角。θy为航向角,表示绕z轴与y轴的夹角。θz为横滚角,表示绕x轴与y轴的夹角。The three-dimensional coordinate system in the embodiment of the present application can be understood by referring to FIG. 6A. As shown in FIG. 6A, the direction parallel to the coal surface is defined as the x-axis, and the direction perpendicular to the coal surface is defined as the y-axis, and the x-axis and the y-axis The direction perpendicular to the plane is defined as the z-axis. Among them, θx is the pitch angle, indicating the angle between the y-axis and the x-axis. θy is the heading angle, indicating the angle between the z-axis and the y-axis. θz is the roll angle, indicating the angle between the x-axis and the y-axis.
支架的姿态角信息(θnx,θny,θnz)还可以通过另一种形式来表示,如图6B所示,用支架在三维坐标系中的投影与x、y、z三个轴的夹角来表示θnx,θny,θnz。The attitude angle information (θnx, θny, θnz) of the bracket can also be expressed in another form, as shown in Figure 6B, using the angle between the projection of the bracket in the three-dimensional coordinate system and the three axes x, y, and z Indicates θnx, θny, θnz.
403.控制设备根据每个支架的位置信息,确定第一曲线,该第一曲线用于描述每个支架的位置分布。403. The control device determines a first curve according to the position information of each support, where the first curve is used to describe the position distribution of each support.
每个支架的位置信息为每个支架的坐标,第n个支架在调直方向上的坐标可以表示为(Xn,Yn,Zn)。The position information of each support is the coordinates of each support, and the coordinates of the nth support in the straightening direction can be expressed as (Xn, Yn, Zn).
如果,支架有n个,那个每个支架在y轴上的坐标即可以表示为(X1,Y1,Z1)、(X2,Y2,Z2),…,(Xn,Yn,Zn)。第一曲线可以是将n个支架的坐标点连接起来形成的曲线。If there are n supports, the coordinates of each support on the y-axis can be expressed as (X1, Y1, Z1), (X2, Y2, Z2), . . . , (Xn, Yn, Zn). The first curve may be a curve formed by connecting coordinate points of n supports.
该第一曲线可以参阅图7A进行理解,如图7A所示,可以是通过直线将每个支架的坐标点连接。本申请实施例提供的第一曲线不限于图7A所示的方式,还可以是对每个支架的坐标做拟合处理后得到的曲线。The first curve can be understood with reference to FIG. 7A . As shown in FIG. 7A , the coordinate points of each bracket can be connected by a straight line. The first curve provided in the embodiment of the present application is not limited to the manner shown in FIG. 7A , and may also be a curve obtained by fitting the coordinates of each bracket.
404.若第一曲线中在调直方向上的最大波峰值或者最大波谷值超出第一阈值,或者在调直方向上最大波峰值与最大波谷值的差值超出第二阈值,则控制设备确定每个支架在调直方向上的位置信息,与每个支架在调直方向上所对应的第一目标值的第一差值。404. If the maximum peak value or maximum valley value in the straightening direction in the first curve exceeds the first threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the second threshold, the control device determines that each The position information of the bracket in the straightening direction, and the first difference between the first target value corresponding to each bracket in the straightening direction.
本申请实施例中,若第一曲线中在调直方向上的最大波峰值或者最大波谷值没有超出第一阈值,或者在调直方向上最大波峰值与最大波谷值的差值没有超出第二阈值,则不执行确定第一差值和第一调节量的步骤。In the embodiment of the present application, if the maximum peak value or the maximum valley value in the straightening direction in the first curve does not exceed the first threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction does not exceed the second threshold, Then the step of determining the first difference and the first adjustment amount is not performed.
本申请实施例中,条件1:第一曲线中在调直方向上的最大波峰值或者最大波谷值超出第一阈值,或者,条件2:在调直方向上最大波峰值与最大波谷值的差值超出第二阈值。其中条件1和条件2只需要选择一个即可,这两个条件可以是预先配置好的一个,控制设备中配置的是条件1,在运行时就执行条件1。控制设备中配置的是条件2,在运行时就执行条件2。In the embodiment of the present application, condition 1: the maximum peak value or maximum valley value in the straightening direction in the first curve exceeds the first threshold, or condition 2: the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds second threshold. Among them, only one of condition 1 and condition 2 needs to be selected, and these two conditions can be a pre-configured one, and condition 1 is configured in the control device, and condition 1 is executed during operation. Condition 2 is configured in the control device, and condition 2 is executed at runtime.
第一阈值和第二阈值可以是预配置的值,如:1厘米到50厘米,或者其他数值,如果第一曲线中在调直方向上的最大波峰值或者最大波谷值未超出第一阈值,或者在调直方向上的最大波峰值与最大波谷值的差值未超出第二阈值,则表示当前支架阵列比较直,不需要执行调直处理,可以节省用于调直的时间,从而提高采煤机的工作效率。The first threshold and the second threshold may be preconfigured values, such as: 1 cm to 50 cm, or other values, if the maximum peak value or the maximum valley value in the straightening direction in the first curve does not exceed the first threshold value, or The difference between the maximum peak value and the maximum trough value in the straightening direction does not exceed the second threshold, which means that the current support array is relatively straight and does not need to perform straightening processing, which can save time for straightening and improve the shearer. work efficiency.
本申请实施例中,第一差值为第一目标值与支架在调直方向上的坐标值的差值,该差 值可以是正值或负值,正值表示与调直方向相同,负值表示与调直方向相反。以调直方向是y轴为例,第n个支架在y轴方向上的坐标为Yn,对应的第一目标值为Fn,则第一差值=Fn-Yn。每个支架的第一目标值也可以用一条直线表示,如图7B所示,直线F表示每个支架的第一目标值所在的直线,图7B中所示出的直线F是平行于x轴的,实际上,该直线F也可以是相对于x轴有角度的,不限于图7B中所表示的方式。每个支架的第一差值即为每个支架的坐标点到直线F的距离。In the embodiment of the present application, the first difference is the difference between the first target value and the coordinate value of the bracket in the straightening direction. The difference can be positive or negative. A positive value means the same as the straightening direction, and a negative value Indicates that it is opposite to the straightening direction. Taking the straightening direction as the y-axis as an example, the coordinate of the nth support in the y-axis direction is Yn, and the corresponding first target value is Fn, then the first difference=Fn-Yn. The first target value of each bracket can also be represented by a straight line, as shown in Figure 7B, the straight line F represents the straight line where the first target value of each bracket is located, and the straight line F shown in Figure 7B is parallel to the x-axis Yes, in fact, the straight line F can also be angled with respect to the x-axis, not limited to the way shown in FIG. 7B. The first difference of each bracket is the distance from the coordinate point of each bracket to the straight line F.
405.控制设备将每个支架的第一差值,与每个支架在调直方向上的余弦数据的商确定为第一调节量。405. The control device determines the quotient of the first difference value of each support and the cosine data of each support in the straightening direction as the first adjustment amount.
其中,余弦数据包括第一余弦,或者,第一余弦与第二余弦和第三余弦中至少一个的乘积,第一余弦为B个支架中每个支架在调直方向上的航向角的余弦,第二余弦为B个支架中每个支架在调直方向上的横滚角的余弦,第三余弦为B个支架中每个支架在调直方向上的俯仰角的余弦,航向角、横滚角,俯仰角包含于B个支架中每个支架的姿态角信息中。Wherein, the cosine data includes the first cosine, or the product of the first cosine and at least one of the second cosine and the third cosine, and the first cosine is the heading of each bracket in the straightening direction in the B brackets The cosine of the angle, the second cosine is the cosine of the roll angle of each bracket in the B brackets in the straightening direction, the third cosine is the cosine of the pitch angle of each bracket in the B brackets in the straightening direction, and the heading Angle, roll angle, and pitch angle are included in the attitude angle information of each bracket in the B brackets.
本申请实施例中,第一调节量=(Fn-Yn)/余弦数据,第一余弦=cosθny,第二余弦=cosθnz,第三余弦=cosθnx,余弦数据可以是cosθny,也可以是cosθny.cosθnz,cosθny.cosθnx或者cosθny.cosθnz.cosθnx,其中,“.”表示乘号。本申请在计算第一调节量时考虑到了支架可能会受影响的各种角度因素,这样计算出来的第一调节量更精准,进一步提高了支架阵列调直的精准度。In the embodiment of the present application, the first adjustment amount=(Fn-Yn)/cosine data, the first cosine=cosθny, the second cosine=cosθnz, the third cosine=cosθnx, and the cosine data can be cosθny or cosθny.cosθnz, cosθny.cosθnx or cosθny.cosθnz.cosθnx, where "." represents the multiplication sign. When calculating the first adjustment amount, the present application takes into account various angle factors that may be affected by the bracket, so that the calculated first adjustment amount is more accurate, and further improves the alignment accuracy of the bracket array.
406.控制设备根据每个支架的位置信息,以及每个支架的推杆伸出的长度值,以及每个支架的姿态角信息,确定每个目标节点的坐标信息。406. The control device determines the coordinate information of each target node according to the position information of each support, the protruding length value of the push rod of each support, and the attitude angle information of each support.
本申请实施例中,一个支架的坐标为(Xn,Yn,Zn),姿态信息为(θnx,θny,θnz),推杆伸出的长度值为dn,对应目标节点的坐标信息为(an、bn、cn),以在y轴方向上为例,bn=Yn+dn/cosθny。an=Xn+dn/cosθnx,cn=Zn+dn/cosθnz。In the embodiment of the present application, the coordinates of a bracket are (Xn, Yn, Zn), the posture information is (θnx, θny, θnz), the length of the push rod is dn, and the coordinate information of the corresponding target node is (an, bn, cn), taking the y-axis direction as an example, bn=Yn+dn/cosθny. an=Xn+dn/cosθnx, cn=Zn+dn/cosθnz.
407.控制设备根据每个目标节点的坐标信息,确定第二曲线,第二曲线用于描述每个目标节点的位置分布。407. The control device determines a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node.
目标节点即为刮板机上与支架上的推杆连接的节点。第二曲线可以参阅第一曲线的图7A进行理解。The target node is the node connected with the push rod on the bracket on the scraper machine. The second curve can be understood with reference to FIG. 7A of the first curve.
408.若第二曲线中在调直方向上的最大波峰值或者最大波谷值超出第三阈值,或者在调直方向上的最大波峰值与最大波谷值的差值超出第四阈值,则控制设备确定每个目标节点的在调直方向上的坐标信息,与在调直方向上每个目标节点所对应的第二目标值的第二差值。408. If the maximum peak value or maximum valley value in the straightening direction in the second curve exceeds the third threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the fourth threshold, the control device determines that every The second difference between the coordinate information of each target node in the straightening direction and the second target value corresponding to each target node in the straightening direction.
本申请实施例中,若第二曲线中在调直方向上的最大波峰值或者最大波谷值没有超出第三阈值,或者在调直方向上最大波峰值与最大波谷值的差值没有超出第四阈值,则不执行确定第二差值和第二调节量的步骤。In the embodiment of the present application, if the maximum peak value or the maximum valley value in the straightening direction in the second curve does not exceed the third threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction does not exceed the fourth threshold, Then the step of determining the second difference and the second adjustment amount is not performed.
本申请实施例中,条件3:第二曲线中在调直方向上的最大波峰值或者最大波谷值没有超出第三阈值,或者,条件4:在调直方向上最大波峰值与最大波谷值的差值没有超出第四阈值。其中条件3和条件4只需要选择一个即可,这两个条件可以是预先配置好的一个,控制设备中配置的是条件3,在运行时就执行条件3。控制设备中配置的是条件4,在 运行时就执行条件4。In the embodiment of the present application, condition 3: the maximum peak value or maximum valley value in the straightening direction in the second curve does not exceed the third threshold, or condition 4: the difference between the maximum peak value and the maximum valley value in the straightening direction The fourth threshold is not exceeded. Among them, only one of condition 3 and condition 4 needs to be selected, and these two conditions can be a pre-configured one, and condition 3 is configured in the control device, and condition 3 is executed during operation. Condition 4 is configured in the control device, and condition 4 is executed at runtime.
第三阈值和第四阈值可以是预配置的值,如:1厘米到50厘米,或者其他数值,如果第二曲线中的最大波峰值或者最大波谷值未超出第三阈值,或者在调直方向上的最大波峰值与最大波谷值的差值未超出第四阈值,则表示当前刮板机比较直,不需要执行调直处理,可以节省用于调直的时间,从而提高采煤机的工作效率。The third threshold and the fourth threshold can be pre-configured values, such as: 1 cm to 50 cm, or other values, if the maximum peak or maximum valley value in the second curve does not exceed the third threshold, or in the straightening direction The difference between the maximum peak value and the maximum valley value does not exceed the fourth threshold, which means that the current scraper is relatively straight and does not need to be straightened, which can save time for straightening and improve the working efficiency of the shearer .
本申请实施例中,第二差值为第二目标值En与bn的差值(En-bn),该差值可以是正值或负值,正值表示与调直方向相同,负值表示与调直方向相反。第二差值的计算方式可以参阅第一差值的计算方式进行理解,也可以参阅图7B进行理解。In the embodiment of the present application, the second difference is the difference (En-bn) between the second target value En and bn. The difference can be positive or negative. A positive value means the same direction as the straightening direction, and a negative value means Opposite to straightening direction. The calculation method of the second difference can be understood by referring to the calculation method of the first difference, and can also be understood by referring to FIG. 7B .
409.控制设备将每个目标节点所对应的第二差值,与每个目标节点在调直方向上的余弦数据的商确定为第二调节量。409. The control device determines the quotient of the second difference corresponding to each target node and the cosine data of each target node in the straightening direction as the second adjustment amount.
其中,余弦数据包括第四余弦,或者,第四余弦与第五余弦和第六余弦中至少一个的乘积,第四余弦为每个目标节点所连接的推杆在调直方向上的航向角的余弦,第五余弦为每个目标节点所连接的推杆在调直方向上的横滚角的余弦,第六余弦为每个目标节点所连接的推杆在调直方向上的俯仰角的余弦,航向角、横滚角,俯仰角包含于每个目标节点所连接的推杆的姿态角信息中,每个目标节点所连接的推杆的姿态角信息为推杆所在的支架的姿态角信息。Wherein, the cosine data includes the fourth cosine, or the product of the fourth cosine and at least one of the fifth cosine and the sixth cosine, and the fourth cosine is the straightening direction of the push rod connected to each target node The cosine of the heading angle, the fifth cosine is the cosine of the roll angle of the push rod connected to each target node in the straightening direction, and the sixth cosine is the roll angle of the push rod connected to each target node in the straightening direction The cosine of the pitch angle, heading angle, roll angle, and pitch angle are included in the attitude angle information of the push rod connected to each target node, and the attitude angle information of the push rod connected to each target node is the bracket where the push rod is located attitude angle information.
本申请实施例中,因为推杆的姿态角信息与支架的姿态角信息相同,所以第四余弦与第一余弦相同,第五余弦与第二余弦相同,第六余弦与第三余弦相同。第四余弦=cosθny,第五余弦=cosθnz,第六余弦=cosθnx,余弦数据可以是cosθny,也可以是cosθny.cosθnz,cosθny.cosθnx或者cosθny.cosθnz.cosθnx。本申请在计算第二调节量时考虑到了推杆可能会受影响的各种角度因素,这样计算出来的第二调节量更精准,进一步提高了刮板机调直的精准度。In the embodiment of the present application, because the attitude angle information of the push rod is the same as that of the bracket, the fourth cosine is the same as the first cosine, the fifth cosine is the same as the second cosine, and the sixth cosine is the same as the first cosine. The three cosines are the same. The fourth cosine=cosθny, the fifth cosine=cosθnz, the sixth cosine=cosθnx, the cosine data can be cosθny, cosθny.cosθnz, cosθny.cosθnx or cosθny.cosθnz.cosθnx. The present application takes into account various angle factors that may be affected by the push rod when calculating the second adjustment amount, so that the calculated second adjustment amount is more accurate, and further improves the straightening accuracy of the scraper machine.
410.控制设备向每个支架发送对应的第一调节量和/或第二调节量。410. The control device sends the corresponding first adjustment amount and/or the second adjustment amount to each bracket.
然后支架根据第一调节量进行拉架移动,以调直支架阵列,和/或,根据第二调节量进行推溜,以调直刮板机。Then the bracket moves according to the first adjustment amount to straighten the bracket array, and/or pushes and slides according to the second adjustment amount to straighten the scraper.
本申请实施例中,如果只需要调直支架阵列,则只需要确定第一调节量,不需要确定第二调节量,则不需要执行步骤406到409。如果只需要调直刮板机,则只需要确定第二调节量,不需要确定第一调节量,则不需要执行步骤403到405。如果既要调直支架阵列,又要调直刮板机,则需要确定第一调节量和第二调节量。In the embodiment of the present application, if only the bracket array needs to be straightened, only the first adjustment amount needs to be determined, and the second adjustment amount does not need to be determined, and steps 406 to 409 do not need to be performed. If it is only necessary to straighten the scraper, only the second adjustment amount needs to be determined, and the first adjustment amount does not need to be determined, so steps 403 to 405 do not need to be performed. If it is necessary to straighten both the bracket array and the scraper, it is necessary to determine the first adjustment amount and the second adjustment amount.
另外,本申请实施例中,支架阵列中相邻的两个支架可以通过两侧的驱动机构来推动另一个支架旋转一定的角度,如:调直方向是y轴方向,则可以通过x轴方向的推杆来推动相邻的支架旋转,从而调正支架阵列中发生角度旋转的支架。In addition, in the embodiment of the present application, two adjacent brackets in the bracket array can push the other bracket to rotate by a certain angle through the driving mechanisms on both sides. For example, if the straightening direction is the y-axis direction, then the x-axis direction can The push rod of the stent is used to push the adjacent stent to rotate, so as to adjust the angular rotation of the stent in the stent array.
该过程可以是控制设备根据每个支架在调直方向上的航向角的测量值,以及在调直方向上的航向角的目标值,确定每个支架的航向角的补偿值;控制设备向每个支架的相邻支架发送对应航向角的补偿值,用于相邻支架调整每个支架位置,以将每个支架调整到航向角的目标值。This process can be that the control device determines the compensation value of the heading angle of each bracket according to the measured value of the heading angle of each bracket in the straightening direction and the target value of the heading angle in the straightening direction; The adjacent brackets send the compensation value corresponding to the heading angle, which is used for the adjacent brackets to adjust the position of each bracket, so as to adjust each bracket to the target value of the heading angle.
需要说明的是,本申请实施例中,航向角的补偿值包括角度的补偿值和推动相邻支架 的推杆的推移补偿值,如果平行于煤面的方向是x轴,推动相邻支架的推杆通常指的是x轴方向上的推杆。其中,角度的补偿值可以是航向角的目标值与航向角的测量值的差值,推杆的推移补偿值可以是根据支架的底板在Y轴方向的长度以及角度的补偿值来确定调正支架在x轴方向上需要推移的距离。It should be noted that in the embodiment of the present application, the compensation value of the course angle includes the compensation value of the angle and the displacement compensation value of the push rod that pushes the adjacent support. If the direction parallel to the coal surface is the x-axis, the push rod of the adjacent support Push rods generally refer to push rods in the x-axis direction. Wherein, the compensation value of the angle can be the difference between the target value of the heading angle and the measured value of the heading angle, and the pushing compensation value of the push rod can be determined according to the length of the bottom plate of the bracket in the Y-axis direction and the compensation value of the angle. The distance that the bracket needs to move in the x-axis direction.
由以上描述可知,本申请实施例通过对支架阵列和刮板机的目标节点的直线度监测可以调直刮板机和/或支架阵列,以及调正航向角,下面通过图8A至图8D来展示调直及调正的过程。From the above description, it can be seen that the embodiment of the present application can straighten the scraper machine and/or the bracket array and adjust the heading angle by monitoring the straightness of the target node of the support array and the scraper machine, as shown in Figure 8A to Figure 8D below Demonstrate the straightening and adjustment process.
如图8A所示,支架阵列中有n个支架,每个支架的位置信息都可以通过三维坐标来表示,具体表示方式可以参阅前面的介绍。在直线度监测的支架阵列图中可以看出第一曲线和第二曲线都是曲线。则可以按照前面的方案对刮板机和/或支架阵列进行调直。As shown in FIG. 8A , there are n brackets in the bracket array, and the position information of each bracket can be represented by three-dimensional coordinates, and the specific representation method can refer to the above introduction. It can be seen from the straightness monitoring stent array diagram that both the first curve and the second curve are curves. Then the scraper machine and/or bracket array can be straightened according to the previous scheme.
如果先调直刮板机,则可以在图8A的基础上,得到图8B所示的效果。第二曲线变成了直线,表示刮板机被调直了。If the scraper is straightened first, the effect shown in Figure 8B can be obtained on the basis of Figure 8A. The second curve becomes a straight line, indicating that the scraper is straightened.
然后在图8B的基础上再调支架阵列,或者在图8A的基础上同时调支架阵列和刮板机,就可以得到图8C所示的效果,不仅第二曲线变成了直线,第一曲线也变成了直线,表示刮板机和支架阵列都被调直了。Then adjust the bracket array on the basis of Figure 8B, or adjust the bracket array and the scraper at the same time on the basis of Figure 8A, you can get the effect shown in Figure 8C, not only the second curve becomes a straight line, the first curve It also becomes a straight line, indicating that both the scraper and the bracket array are straightened.
在图8C的基础上,再进一步调正支架阵列中的支架,即支架的航向角调正可以参阅图8D进行理解,如图8D所示,通过相邻支架沿着x轴方向的推杆及其驱动机构(图中未示出)可以调整航向角。On the basis of Figure 8C, further adjust the brackets in the bracket array, that is, the course angle adjustment of the brackets can be understood by referring to Figure 8D, as shown in Figure 8D, through the push rods and Its driving mechanism (not shown in the figure) can adjust the heading angle.
上述从图8A到图8D的调整过程可以是控制设备根据支架的坐标(xn,yn,zn),及三维姿态(θx,θy,θz),以及刮板机的目标节点的坐标(an,bn,cn),获得支架阵列、刮板机在空间中的分布状态。设x轴为平行煤面方向,y轴为垂直煤面方向,z轴为垂直水平面XY方向,XYZ满足右手定则。本实施例以Y轴方向找直为例,即拟合支架阵列、刮板机的目标节点的Y轴坐标直线度,判断Y轴坐标的最大差值,分别记为H、K,实现实时找直监测。The above-mentioned adjustment process from Figure 8A to Figure 8D can be based on the coordinates (xn, yn, zn) of the control device, the three-dimensional posture (θx, θy, θz), and the coordinates of the target node of the scraper (an, bn ,cn), to obtain the distribution state of the bracket array and the scraper machine in space. Let the x-axis be the direction parallel to the coal surface, the y-axis be the direction vertical to the coal surface, and the z-axis be the XY direction vertical to the horizontal plane, and XYZ satisfy the right-hand rule. This embodiment takes straightening in the Y-axis direction as an example, that is, fitting the straightness of the Y-axis coordinates of the target nodes of the bracket array and the scraper machine, and judging the maximum difference of the Y-axis coordinates, which are recorded as H and K respectively, to realize real-time alignment. Monitor directly.
当找直监测获得H大于50cm,支架阵列可以通过跟机拉架补偿实现调直,即实现支架阵列的Y轴坐标对齐,使得H<G,G为找直的目标值,范围可以为0~50cm。设定目标Y轴坐标值,分别计算支架Y轴坐标与目标值的差值L,即可获得每个支架的跟机拉架补偿量。跟机拉架可以通过降架、伸缩推杆实现正、负距离的调节。推杆伸缩量(dns–dn)等于L除以航向角的余弦值,当地面不平时,还要继续除以横滚角和俯仰角的余弦值。When the straightening monitoring obtains H greater than 50cm, the bracket array can be straightened by compensating with the machine, that is, the Y-axis coordinates of the bracket array are aligned, so that H<G, G is the target value of straightening, and the range can be 0 to 50cm . Set the target Y-axis coordinate value, calculate the difference L between the Y-axis coordinate of the support and the target value, and then obtain the compensation amount of the follower frame for each support. The follower frame can adjust the positive and negative distances by lowering the frame and telescopic push rod. The telescopic amount of the push rod (dns–dn) is equal to L divided by the cosine of the heading angle. When the ground is uneven, it must be further divided by the cosine of the roll and pitch angles.
当找直监测获得K大于50cm,刮板机可以通过支架推溜补偿实现调直,即实现刮板机节点的Y轴坐标对齐,使得K<G,G为找直的目标值,范围可以为0~50cm。设定目标Y轴坐标值,分别计算刮板机节点Y轴坐标与目标值的差值T,即可获得各个刮板机节点的推杆推溜补偿量。支架支护时,通过推杆的伸缩运动可以实现推溜正、负距离的调节。推杆伸缩量(dnt–dn)等于T除以航向角的余弦值,当地面不平时,还要继续除以横滚角和俯仰角的余弦值。When the straightening monitoring obtains K greater than 50cm, the scraper machine can be straightened through the bracket pushing compensation, that is, the Y-axis coordinates of the scraper machine nodes are aligned, so that K<G, G is the target value of straightening, and the range can be 0~50cm. Set the target Y-axis coordinate value, calculate the difference T between the Y-axis coordinate of the scraper node and the target value, and then obtain the push rod push compensation amount of each scraper node. When the bracket is supported, the adjustment of the positive and negative distances of the push rod can be realized through the telescopic movement of the push rod. The telescopic amount of the push rod (dnt–dn) is equal to T divided by the cosine of the heading angle. When the ground is uneven, it must be further divided by the cosine of the roll and pitch angles.
当循环直线度监测和驱动跟机拉架、推溜调直过程,直至时H<G、K<G,即为闭环调直。另一种方法是设置支架阵列、刮板机的目标位置,目标位置满足上述直线度要求,作为系统控制目标,通过支架、刮板机节点的位置和姿态信息进行闭环驱动跟机拉架、推溜, 保证每次跟机拉架、推溜完成后,支架阵列、刮板机达到目标位置,同时满足直线度要求。该过程属于在控制支架和刮板机作业运动的过程中同时进行调直。When the cycle straightness monitoring and driving follower pull frame, push and slide straightening process until H<G, K<G, it is closed-loop straightening. Another method is to set the target position of the bracket array and the scraper machine. The target position meets the above straightness requirements, and as the system control target, the closed-loop drive is followed by the machine pulling frame and pushing through the position and attitude information of the bracket and scraper machine nodes. , to ensure that the rack array and the scraper machine reach the target position and meet the straightness requirements after each follow-up frame pulling and pushing is completed. This process belongs to simultaneous straightening during the process of controlling the working movement of the bracket and scraper machine.
本申请实施例提供的方案,可以通过直接阵列中每个支架的位置信息和姿态角信息实现对支架阵列和/或刮板机的自动调直,而且调直的精准度很高。The solution provided by the embodiment of the present application can realize the automatic alignment of the bracket array and/or the scraper machine through the position information and attitude angle information of each bracket in the direct array, and the alignment accuracy is very high.
二.控制设备控制支架阵列中间隔的支架进行,支架阵列的调直和/或刮板机的调直。2. The control device controls the spaced brackets in the bracket array to perform straightening of the bracket array and/or the straightening of the scraper machine.
本申请实施例中,可以均匀间隔安装IMU和行程传感器,如图9所示,每M个支架安装IMU和行程传感器,M取值范围通常为0~20。图9中有nM个支架,这样可以其中n个支架的位置信息和姿态角信息,然后对支架阵列和/或刮板机进行调直,具体的调直过程可以参阅前面图5至图8D部分的介绍进行理解,此处不再重复介绍。In the embodiment of the present application, the IMU and the travel sensor can be installed at even intervals. As shown in FIG. 9 , the IMU and the travel sensor are installed on every M brackets, and the value of M usually ranges from 0 to 20. There are nM brackets in Figure 9, so that the position information and attitude angle information of n brackets can be obtained, and then the bracket array and/or the scraper machine can be straightened. For the specific straightening process, please refer to the previous part of Figure 5 to Figure 8D The introduction is understood, and the introduction will not be repeated here.
图9是以均匀间隔为例进行介绍的,本申请实施例中不限于均匀间隔的方式,也可以是不均匀间隔。FIG. 9 uses uniform intervals as an example for introduction. In the embodiment of the present application, the method is not limited to uniform intervals, and may also be uneven intervals.
本申请实施例提供的间隔安装IMU和行程传感器的方式,可以降低硬件成本,又能达到调直支架阵列和/或刮板机的效果。The method of installing the IMU and the stroke sensor at intervals provided by the embodiment of the present application can reduce the hardware cost and achieve the effect of straightening the bracket array and/or the scraper.
以上介绍了多节点设备的调直方法,以及综采面系统中的支架,下面对本申请实施例提供的控制设备进行介绍。The straightening method of the multi-node equipment and the support in the fully mechanized mining face system have been introduced above, and the control equipment provided by the embodiment of the present application will be introduced below.
如图10所示,本申请实施例提供的控制设备50包含于综采面系统,该控制设备包含于综采面系统,综采面系统还包括支架阵列和刮板机,支架阵列包括A个支架,其中,A个支架中的每个支架都通过推杆与刮板机连接,A为大于1的整数,该控制设备包括:As shown in Figure 10, the control device 50 provided by the embodiment of the present application is included in the fully mechanized mining face system, and the control device is included in the fully mechanized mining face system. A bracket, wherein, each bracket in the A brackets is connected to the scraper machine through a push rod, A is an integer greater than 1, and the control device includes:
获取单元501,用于获取支架阵列中B个支架的位置信息和姿态角信息,B=A,或者,B个支架间隔分布在A个支架中,B为正整数。该获取单元501可以执行前述方法实施例中的步骤201和401。The acquiring unit 501 is configured to acquire position information and attitude angle information of B brackets in the bracket array, where B=A, or B brackets are distributed in A brackets at intervals, and B is a positive integer. The obtaining unit 501 may execute steps 201 and 401 in the foregoing method embodiments.
处理单元502,用于根据获取单元501获取的B个支架中每个支架的位置信息和姿态角信息,以及在调直方向上B个支架中每个支架对应的第一目标值,确定B个支架中每个支架的第一调节量,和/或,根据B个支架中每个支架的位置信息和姿态角信息、B个支架中每个支架的推杆伸出的长度值,以及在调直方向上每个目标节点所对应的第二目标值,确定每个目标节点的第二调节量,目标节点为B个支架中每个支架的推杆与刮板机的连接点。该处理单元502可以执行前述方法实施例中的步骤202和402-409。The processing unit 502 is configured to determine the B brackets according to the position information and attitude angle information of each bracket in the B brackets acquired by the acquisition unit 501, and the first target value corresponding to each bracket in the B brackets in the straightening direction The first adjustment amount of each bracket in the B brackets, and/or, according to the position information and attitude angle information of each bracket in the B brackets, the length value of the push rod of each bracket in the B brackets, and the straightening method Up to the second target value corresponding to each target node, determine the second adjustment amount of each target node, the target node is the connection point between the push rod of each bracket in the B brackets and the scraper machine. The processing unit 502 may execute steps 202 and 402-409 in the foregoing method embodiments.
发送单元503,用于向B个支架中每个支架发送对应的处理单元502确定的第一调节量和/或第二调节量,第一调节量用于B个支架中每个支架在调直方向上进行拉架移动,以调直支架阵列,第二调节量用于每个目标节点所连接的推杆进行推溜,以调直刮板机。该发送单元503可以执行前述方法实施例中的步骤203和410。The sending unit 503 is configured to send the first adjustment amount and/or the second adjustment amount determined by the corresponding processing unit 502 to each bracket in the B brackets, the first adjustment amount is used for each bracket in the B brackets in the straightening direction The rack moves upwards to straighten the bracket array, and the second adjustment amount is used to push the push rods connected to each target node to straighten the scraper. The sending unit 503 may execute steps 203 and 410 in the foregoing method embodiments.
本申请实施例中,可以通过控制设备自动调直支架阵列和/或刮板机,实现了对支架阵列和/或刮板机调直的自动化,另外,本申请中,在调直支架阵列和/或刮板机时还充分考虑了支架的姿态角信息,提高了支架阵列和/或刮板机调直的精准度。In the embodiment of the present application, the automatic straightening of the support array and/or the scraper machine can be realized through the control equipment, and the automation of the straightening of the support array and/or the scraper machine is realized. In addition, in this application, in the straightening of the support array and The attitude angle information of the support is also fully considered during the /or scraper machine, which improves the alignment accuracy of the bracket array and/or the scraper machine.
可选地,B个支架中每个支架上都设置有惯性测量单元IMU以及行程传感器,行程传感器设置于推杆的驱动机构上;IMU用于测量支架的角速度信息和加速度信息,角速度信息和加速度信息用于控制设备确定支架的姿态角信息和位置信息;行程传感器用于测量支 架的拉架位移信息和推溜位移信息,拉架位移信息和推溜位移信息结合姿态角信息和位置信息用于控制设备确定刮板机上目标节点的坐标信息。Optionally, each bracket in the B brackets is provided with an inertial measurement unit IMU and a travel sensor, and the travel sensor is arranged on the drive mechanism of the push rod; the IMU is used to measure the angular velocity information and acceleration information of the bracket, angular velocity information and acceleration The information is used to control the equipment to determine the attitude angle information and position information of the bracket; the travel sensor is used to measure the rack displacement information and push displacement information of the bracket, and the rack displacement information and push displacement information are combined with attitude angle information and position information to control the equipment Determine the coordinate information of the target node on the scraper.
可选地,处理单元502用于:确定B个支架中每个支架在调直方向上的位置信息,与B个支架中每个支架在调直方向上所对应的第一目标值的第一差值;将B个支架中每个支架的第一差值,与B个支架中每个支架在调直方向上的余弦数据的商确定为第一调节量;其中,余弦数据包括第一余弦,或者,第一余弦与第二余弦和第三余弦中至少一个的乘积,第一余弦为B个支架中每个支架在调直方向上的航向角的余弦,第二余弦为B个支架中每个支架在调直方向上的横滚角的余弦,第三余弦为B个支架中每个支架在调直方向上的俯仰角的余弦,航向角、横滚角,俯仰角包含于B个支架中每个支架的姿态角信息中。Optionally, the processing unit 502 is configured to: determine the position information of each of the B brackets in the straightening direction, and the first difference from the first target value corresponding to each of the B brackets in the straightening direction ; The first difference of each bracket in the B brackets, and the quotient of the cosine data of each bracket in the straightening direction in the B brackets are determined as the first adjustment amount; wherein the cosine data includes the first cosine, or , the product of the first cosine and at least one of the second cosine and the third cosine, the first cosine is the cosine of the heading angle of each bracket in the straightening direction in the B brackets, and the second cosine is the B brackets The cosine of the roll angle of each bracket in the straightening direction, the third cosine is the cosine of the pitch angle of each bracket in the B brackets in the straightening direction, the heading angle, roll angle, and pitch angle are included in B In the attitude angle information of each bracket in a bracket.
可选地,处理单元502还用于:根据B个支架中每个支架的位置信息,确定第一曲线,第一曲线用于描述B个支架的位置分布;若第一曲线中在调直方向上的最大波峰值或者最大波谷值超出第一阈值,或者在调直方向上的最大波峰值与最大波谷值的差值超出第二阈值,则执行确定第一调节量的步骤。Optionally, the processing unit 502 is further configured to: determine the first curve according to the position information of each bracket in the B brackets, the first curve is used to describe the position distribution of the B brackets; if the first curve is in the straightening direction If the maximum peak value or the maximum valley value exceeds the first threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the second threshold, the step of determining the first adjustment amount is executed.
可选地,处理单元502用于:根据B个支架中每个支架的位置信息,以及B个支架中每个支架的推杆伸出的长度值,以及B个支架中每个支架的姿态角信息,确定每个目标节点的坐标信息;确定每个目标节点的在调直方向上的坐标信息,与在调直方向上每个目标节点所对应的第二目标值的第二差值;将每个目标节点所对应的第二差值,与每个目标节点在调直方向上的余弦数据的商确定为第二调节量;其中,余弦数据包括第四余弦,或者,第四余弦与第五余弦和第六余弦中至少一个的乘积,第四余弦为每个目标节点所连接的推杆在调直方向上的航向角的余弦,第五余弦为每个目标节点所连接的推杆在调直方向上的横滚角的余弦,第六余弦为每个目标节点所连接的推杆在调直方向上的俯仰角的余弦,航向角、横滚角,俯仰角包含于每个目标节点所连接的推杆的姿态角信息中,每个目标节点所连接的推杆的姿态角信息为推杆所在的支架的姿态角信息。Optionally, the processing unit 502 is configured to: according to the position information of each bracket in the B brackets, and the length value of the push rod of each bracket in the B brackets, and the attitude angle of each bracket in the B brackets information, determine the coordinate information of each target node; determine the coordinate information of each target node in the straightening direction, and the second difference between the second target value corresponding to each target node in the straightening direction; each The quotient of the second difference corresponding to the target node and the cosine data of each target node in the straightening direction is determined as the second adjustment amount; wherein, the cosine data includes the fourth cosine, or the fourth cosine and the fifth cosine The product of at least one of the cosine and the sixth cosine, the fourth cosine is the cosine of the heading angle of the push rod connected to each target node in the straightening direction, and the fifth cosine is the The cosine of the roll angle of the stick in the straightening direction, the sixth cosine is the cosine of the pitch angle of the push rod connected to each target node in the straightening direction, the heading angle, roll angle, and pitch angle are included in each target Among the attitude angle information of the push rod connected to the node, the attitude angle information of the push rod connected to each target node is the attitude angle information of the bracket where the push rod is located.
可选地,处理单元502还用于:根据每个目标节点的坐标信息,确定第二曲线,第二曲线用于描述每个目标节点的位置分布;若第二曲线中在调直方向上的最大波峰值或者最大波谷值超出第三阈值,或者在调直方向上的最大波峰值与最大波谷值的差值超出第四阈值,则执行确定第二调节量的步骤。Optionally, the processing unit 502 is further configured to: determine a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node; if the maximum in the straightening direction in the second curve If the peak value or the maximum valley value exceeds the third threshold, or the difference between the maximum peak value and the maximum valley value in the straightening direction exceeds the fourth threshold, the step of determining the second adjustment amount is executed.
可选地,处理单元502还用于:根据B个支架中每个支架在调直方向上的航向角的测量值,以及在调直方向上的航向角的目标值,确定B个支架中每个支架的航向角的补偿值。Optionally, the processing unit 502 is further configured to: determine each of the B brackets according to the measured value of the heading angle of each bracket in the straightening direction and the target value of the heading angle in the straightening direction. The compensation value of the heading angle.
发送单元503,还用于向B个支架中每个支架的相邻支架发送对应航向角的补偿值,航向角的补偿值用于相邻支架调整B个支架中每个支架位置,以将B个支架中每个支架调整到航向角的目标值。The sending unit 503 is also used to send the compensation value of the corresponding heading angle to the adjacent brackets of each bracket in the B brackets, and the compensation value of the heading angle is used for the adjacent brackets to adjust the position of each bracket in the B brackets, so that B Each of the two brackets is adjusted to the target value of the heading angle.
以上,本申请实施例所提供的控制设备50的相关内容可以参阅前述方法实施例部分的相应内容进行理解,此处不再重复赘述。Above, the relevant content of the control device 50 provided in the embodiment of the present application can be understood by referring to the corresponding content in the foregoing method embodiment, and will not be repeated here.
图11所示,为本申请的实施例提供的控制设备60的一种可能的逻辑结构示意图。控制设备60包括:处理器601、通信接口602、内存603、磁盘604以及总线605。处理器601、通 信接口602、内存603以及磁盘604通过总线605相互连接。在本申请的实施例中,处理器601用于对控制设备60的动作进行控制管理,例如,处理器601用于执行图1至图9的方法实施例中的步骤。通信接口602用于支持控制设备60进行通信。内存603,用于存储控制设备60的程序代码和数据,并为进程或线程提供内存空间。磁盘用户存储从内存换出的物理页。FIG. 11 is a schematic diagram of a possible logical structure of the control device 60 provided by the embodiment of the present application. The control device 60 includes: a processor 601 , a communication interface 602 , a memory 603 , a disk 604 and a bus 605 . Processor 601, communication interface 602, memory 603, and disk 604 are connected to each other through bus 605. In the embodiment of the present application, the processor 601 is used to control and manage the actions of the control device 60 , for example, the processor 601 is used to execute the steps in the method embodiments in FIGS. 1 to 9 . The communication interface 602 is used to support the control device 60 to communicate. The memory 603 is used to store program codes and data of the control device 60 and provide memory space for processes or threads. Disk user stores physical pages swapped out from memory.
其中,处理器601可以是中央处理器单元,通用处理器,数字信号处理器,专用集成电路,现场可编程门阵列或者其他可编程逻辑器件、晶体管逻辑器件、硬件部件或者其任意组合。其可以实现或执行结合本申请公开内容所描述的各种示例性的逻辑方框,模块和电路。处理器601也可以是实现计算功能的组合,例如包含一个或多个微处理器组合,数字信号处理器和微处理器的组合等等。总线605可以是外设部件互连标准(Peripheral Component Interconnect,PCI)总线或扩展工业标准结构(Extended Industry Standard Architecture,EISA)总线等。总线可以分为地址总线、数据总线、控制总线等。为便于表示,图11中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。Wherein, the processor 601 may be a central processing unit, a general processor, a digital signal processor, an application specific integrated circuit, a field programmable gate array or other programmable logic devices, transistor logic devices, hardware components or any combination thereof. It can implement or execute the various illustrative logical blocks, modules and circuits described in connection with the present disclosure. The processor 601 may also be a combination that implements computing functions, for example, a combination of one or more microprocessors, a combination of a digital signal processor and a microprocessor, and the like. The bus 605 may be a Peripheral Component Interconnect (PCI) bus or an Extended Industry Standard Architecture (Extended Industry Standard Architecture, EISA) bus, etc. The bus can be divided into address bus, data bus, control bus and so on. For ease of representation, only one thick line is used in FIG. 11 , but it does not mean that there is only one bus or one type of bus.
在本申请的另一实施例中,还提供一种计算机可读存储介质,计算机可读存储介质中存储有计算机执行指令,当设备的处理器执行该计算机执行指令时,设备执行上述图1至图9中控制设备所执行的步骤。In another embodiment of the present application, a computer-readable storage medium is also provided, and computer-executable instructions are stored in the computer-readable storage medium. When the processor of the device executes the computer-executable instructions, the device executes the above-mentioned Figs. Steps performed by the control device in FIG. 9 .
在本申请的另一实施例中,还提供一种计算机程序产品,该计算机程序产品包括计算机执行指令,该计算机执行指令存储在计算机可读存储介质中;当设备的处理器执行该计算机执行指令时,设备执行上述图1至图9中控制设备所执行的步骤。In another embodiment of the present application, a computer program product is also provided, the computer program product includes computer-executable instructions stored in a computer-readable storage medium; when the processor of the device executes the computer-executable instructions , the device executes the steps performed by the control device in FIGS. 1 to 9 above.
在本申请的另一实施例中,还提供一种芯片系统,该芯片系统包括处理器,该处理器用于控制设备实现上述图1至图9中控制设备所执行的步骤。在一种可能的设计中,芯片系统还可以包括存储器,存储器,用于保存控制设备必要的程序指令和数据。该芯片系统,可以由芯片构成,也可以包含芯片和其他分立器件。In another embodiment of the present application, a chip system is further provided, and the chip system includes a processor, and the processor is used to control the device to implement the steps performed by the control device in the foregoing FIGS. 1 to 9 . In a possible design, the system-on-a-chip may further include a memory, and the memory is used to store necessary program instructions and data for controlling the device. The system-on-a-chip may consist of chips, or may include chips and other discrete devices.
本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请实施例的范围。Those skilled in the art can appreciate that the units and algorithm steps of the examples described in conjunction with the embodiments disclosed herein can be implemented by electronic hardware, or a combination of computer software and electronic hardware. Whether these functions are executed by hardware or software depends on the specific application and design constraints of the technical solution. Professionals and technicians may use different methods to implement the described functions for each specific application, but such implementation should not be regarded as exceeding the scope of the embodiments of the present application.
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统、装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。Those skilled in the art can clearly understand that for the convenience and brevity of the description, the specific working process of the above-described system, device and unit can refer to the corresponding process in the foregoing method embodiment, which will not be repeated here.
在本申请实施例所提供的几个实施例中,应该理解到,所揭露的系统、装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。In the several embodiments provided in the embodiments of the present application, it should be understood that the disclosed systems, devices and methods may be implemented in other ways. For example, the device embodiments described above are only illustrative. For example, the division of units is only a logical function division. In actual implementation, there may be other division methods. For example, multiple units or components can be combined or integrated. to another system, or some features may be ignored, or not implemented. In another point, the mutual coupling or direct coupling or communication connection shown or discussed may be through some interfaces, and the indirect coupling or communication connection of devices or units may be in electrical, mechanical or other forms.
作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元 上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。A unit described as a separate component may or may not be physically separated, and a component shown as a unit may or may not be a physical unit, that is, it may be located in one place, or may be distributed to multiple network units. Part or all of the units can be selected according to actual needs to achieve the purpose of the solution of this embodiment.
另外,在本申请实施例各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。In addition, each functional unit in each embodiment of the embodiment of the present application may be integrated into one processing unit, each unit may exist separately physically, or two or more units may be integrated into one unit.
功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请实施例的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本申请实施例各个实施例方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(Read-Only Memory,ROM)、随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。If the functions are realized in the form of software functional units and sold or used as independent products, they can be stored in a computer-readable storage medium. Based on this understanding, the technical solution of the embodiment of the present application is essentially or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium , including several instructions to make a computer device (which may be a personal computer, a server, or a network device, etc.) execute all or part of the steps of the methods in the various embodiments of the embodiments of the present application. The aforementioned storage media include: U disk, mobile hard disk, read-only memory (Read-Only Memory, ROM), random access memory (Random Access Memory, RAM), magnetic disk or optical disc and other media that can store program codes. .

Claims (24)

  1. 一种多节点设备的调直方法,其特征在于,所述方法应用于综采面系统,所述综采面系统包括支架阵列、刮板机和控制设备,所述支架阵列包括A个支架,其中,所述A个支架中的每个支架都通过推杆与所述刮板机连接,所述A为大于1的整数,所述方法包括:A method for straightening multi-node equipment, characterized in that the method is applied to a fully mechanized mining face system, and the fully mechanized mining face system includes a bracket array, a scraper machine and control equipment, and the bracket array includes A brackets, Wherein, each bracket in the A brackets is connected to the scraper machine through a push rod, the A is an integer greater than 1, and the method includes:
    所述控制设备获取所述支架阵列中B个支架的位置信息和姿态角信息,所述B=A,或者,所述B个支架间隔分布在所述A个支架中,所述B为正整数;The control device acquires position information and attitude angle information of B brackets in the bracket array, where B=A, or, the B brackets are distributed among the A brackets at intervals, and B is a positive integer ;
    所述控制设备根据所述B个支架中每个支架的位置信息和姿态角信息,以及在调直方向上所述B个支架中每个支架对应的第一目标值,确定所述B个支架中每个支架的第一调节量,和/或,根据所述B个支架中每个支架的位置信息和姿态角信息、所述B个支架中每个支架的推杆伸出的长度值,以及在所述调直方向上每个目标节点所对应的第二目标值,确定所述每个目标节点的第二调节量,所述目标节点为所述B个支架中每个支架的推杆与所述刮板机的连接点;The control device determines, according to the position information and attitude angle information of each bracket in the B brackets, and the first target value corresponding to each bracket in the B brackets in the straightening direction, The first adjustment amount of each bracket, and/or, according to the position information and attitude angle information of each bracket in the B brackets, the length value of the push rod of each bracket in the B brackets, and The second target value corresponding to each target node in the straightening direction determines the second adjustment amount of each target node, and the target node is the push rod of each bracket in the B brackets and the The connection point of the scraper machine;
    所述控制设备向所述B个支架中每个支架发送对应的所述第一调节量和/或所述第二调节量,所述第一调节量用于所述B个支架中每个支架在所述调直方向上进行拉架移动,以调直所述支架阵列,所述第二调节量用于所述每个目标节点所连接的推杆在所述调直方向上进行推溜,以调直所述刮板机。The control device sends the corresponding first adjustment amount and/or the second adjustment amount to each of the B racks, and the first adjustment amount is used for each of the B racks The frame is moved in the straightening direction to straighten the bracket array, and the second adjustment amount is used to push the push rod connected to each target node in the straightening direction to straighten The scraper.
  2. 根据权利要求1所述的方法,其特征在于,所述B个支架中每个支架上都设置有惯性测量单元IMU以及行程传感器,所述行程传感器设置于所述推杆的驱动机构上;The method according to claim 1, wherein an inertial measurement unit (IMU) and a stroke sensor are arranged on each of the B brackets, and the stroke sensor is arranged on the drive mechanism of the push rod;
    所述IMU用于测量所述支架的角速度信息和加速度信息,所述角速度信息和所述加速度信息用于控制设备确定所述支架的姿态角信息和位置信息;The IMU is used to measure the angular velocity information and acceleration information of the support, and the angular velocity information and the acceleration information are used to control the device to determine the attitude angle information and position information of the support;
    所述行程传感器用于测量所述支架的拉架位移信息和推溜位移信息,所述拉架位移信息和所述推溜位移信息结合所述姿态角信息和所述位置信息用于所述控制设备确定所述刮板机上所述目标节点的坐标信息。The stroke sensor is used to measure the frame displacement information and the push displacement information of the support, and the frame displacement information and the push displacement information are combined with the attitude angle information and the position information for the control device to determine Coordinate information of the target node on the scraper.
  3. 根据权利要求1或2所述的方法,其特征在于,所述控制设备根据所述B个支架中每个支架的位置信息和姿态角信息,以及在调直方向上所述B个支架中每个支架对应的第一目标值,确定所述B个支架中每个支架的第一调节量,包括:The method according to claim 1 or 2, wherein the control device is based on the position information and attitude angle information of each bracket in the B brackets, and each of the B brackets in the straightening direction The first target value corresponding to the bracket determines the first adjustment amount of each bracket in the B brackets, including:
    所述控制设备确定所述B个支架中每个支架在所述调直方向上的位置信息,与所述B个支架中每个支架在所述调直方向上所对应的所述第一目标值的第一差值;The control device determines the position information of each of the B brackets in the straightening direction, and the first target value corresponding to each of the B brackets in the straightening direction first difference;
    所述控制设备将所述B个支架中每个支架的所述第一差值,与所述B个支架中每个支架在所述调直方向上的余弦数据的商确定为所述第一调节量;The control device determines the quotient of the first difference of each of the B brackets and the cosine data of each of the B brackets in the straightening direction as the first adjustment quantity;
    其中,所述余弦数据包括第一余弦,或者,所述第一余弦与所述第二余弦和所述第三余弦中至少一个的乘积,所述第一余弦为所述B个支架中每个支架在所述调直方向上的航向角的余弦,所述第二余弦为所述B个支架中每个支架在所述调直方向上的横滚角的余弦,所述第三余弦为所述B个支架中每个支架在所述调直方向上的俯仰角的余弦,所述航向角、所述横滚角,所述俯仰角包含于所述B个支架中每个支架的姿态角信息中。Wherein, the cosine data includes the first cosine, or the product of the first cosine and at least one of the second cosine and the third cosine, and the first cosine is the B The cosine of the yaw angle of each bracket in the B brackets in the straightening direction, the second cosine is the cosine of the roll angle of each bracket in the B brackets in the straightening direction, and the second cosine is the cosine of the roll angle of each bracket in the B brackets in the straightening direction. The three cosines are the cosines of the pitch angle of each bracket in the B brackets in the straightening direction, the heading angle, the roll angle, and the pitch angle are included in each of the B brackets In the attitude angle information of the bracket.
  4. 根据权利要求1-3任一项所述的方法,其特征在于,所述方法还包括:The method according to any one of claims 1-3, wherein the method further comprises:
    所述控制设备根据所述B个支架中每个支架在所述调直方向上的位置信息,确定第一 曲线,所述第一曲线用于描述所述B个支架在所述调直方向上的位置分布;The control device determines a first curve according to the position information of each of the B brackets in the straightening direction, and the first curve is used to describe the position of the B brackets in the straightening direction distributed;
    若所述第一曲线中在调直方向上的最大波峰值或者最大波谷值超出第一阈值,或者所述最大波峰值与所述最大波谷值的差值超出第二阈值,则所述控制设备执行确定所述第一调节量的步骤。If the maximum peak value or the maximum valley value in the straightening direction in the first curve exceeds a first threshold, or the difference between the maximum peak value and the maximum valley value exceeds a second threshold, the control device executes A step of determining the first adjustment amount.
  5. 根据权利要求1或2所述的方法,其特征在于,所述控制设备根据所述B个支架中每个支架的位置信息和姿态角信息、所述B个支架中每个支架的推杆伸出的长度值,以及在所述调直方向上每个目标节点所对应的第二目标值,确定所述每个目标节点的第二调节量,包括:The method according to claim 1 or 2, wherein the control device is based on the position information and attitude angle information of each bracket in the B brackets, the push rod extension of each bracket in the B brackets The length value obtained, and the second target value corresponding to each target node in the straightening direction, determine the second adjustment amount of each target node, including:
    所述控制设备根据所述B个支架中每个支架的位置信息,以及所述B个支架中每个支架的推杆伸出的长度值,以及所述B个支架中每个支架的姿态角信息,确定每个目标节点的坐标信息;The control device is based on the position information of each bracket in the B brackets, the length value of the push rod of each bracket in the B brackets, and the attitude angle of each bracket in the B brackets. Information, determine the coordinate information of each target node;
    所述控制设备确定所述每个目标节点的在所述调直方向上的坐标信息,与在所述调直方向上所述每个目标节点所对应的第二目标值的第二差值;The control device determines a second difference between coordinate information of each target node in the straightening direction and a second target value corresponding to each target node in the straightening direction;
    所述控制设备将所述每个目标节点所对应的所述第二差值,与所述每个目标节点在所述调直方向上的余弦数据的商确定为所述第二调节量;The control device determines the quotient of the second difference corresponding to each target node and the cosine data of each target node in the straightening direction as the second adjustment amount;
    其中,所述余弦数据包括第四余弦,或者,所述第四余弦与所述第五余弦和所述第六余弦中至少一个的乘积,所述第四余弦为所述每个目标节点所连接的推杆在所述调直方向上的航向角的余弦,所述第五余弦为所述每个目标节点所连接的推杆在所述调直方向上的横滚角的余弦,所述第六余弦为所述每个目标节点所连接的推杆在所述调直方向上的俯仰角的余弦,所述航向角、所述横滚角,所述俯仰角包含于所述每个目标节点所连接的推杆的姿态角信息中,所述每个目标节点所连接的推杆的姿态角信息为所述推杆所在的支架的姿态角信息。Wherein, the cosine data includes the fourth cosine, or the product of the fourth cosine and at least one of the fifth cosine and the sixth cosine, and the fourth cosine is the product of each The cosine of the heading angle of the push rod connected to each target node in the straightening direction, and the fifth cosine is the cosine of the roll angle of the push rod connected to each target node in the straightening direction , the sixth cosine is the cosine of the pitch angle of the push rod connected to each target node in the straightening direction, the heading angle, the roll angle, and the pitch angle are included in the In the attitude angle information of the push rod connected to each target node, the attitude angle information of the push rod connected to each target node is the attitude angle information of the bracket where the push rod is located.
  6. 根据权利要求5所述的方法,其特征在于,所述方法还包括:The method according to claim 5, wherein the method further comprises:
    所述控制设备根据每个目标节点的坐标信息,确定第二曲线,所述第二曲线用于描述所述每个目标节点在所述调直方向上的位置分布;The control device determines a second curve according to the coordinate information of each target node, and the second curve is used to describe the position distribution of each target node in the straightening direction;
    若所述第二曲线中在调直方向上的最大波峰值或者最大波谷值超出第三阈值,或者所述最大波峰值与所述最大波谷值的差值超出第四阈值,则所述控制设备执行确定所述第二调节量的步骤。If the maximum peak value or the maximum valley value in the straightening direction in the second curve exceeds the third threshold, or the difference between the maximum peak value and the maximum valley value exceeds the fourth threshold, the control device executes A step of determining the second adjustment amount.
  7. 根据权利要求1-6任一项所述的方法,其特征在于,所述方法还包括:The method according to any one of claims 1-6, wherein the method further comprises:
    所述控制设备根据所述B个支架中每个支架在所述调直方向上的航向角的测量值,以及在所述调直方向上的所述航向角的目标值,确定所述B个支架中每个支架的所述航向角的补偿值;The control device determines, according to the measured value of the course angle of each support in the B supports in the straightening direction, and the target value of the course angle in the straightening direction, that among the B supports The compensation value of the heading angle of each support;
    所述控制设备向所述B个支架中每个支架的相邻支架发送对应航向角的补偿值,所述航向角的补偿值用于所述相邻支架调整所述B个支架中每个支架位置,以将所述B个支架中每个支架调整到所述航向角的目标值。The control device sends a compensation value corresponding to a heading angle to an adjacent bracket of each of the B brackets, and the compensation value of the heading angle is used by the adjacent bracket to adjust each bracket of the B brackets position, so as to adjust each of the B brackets to the target value of the heading angle.
  8. 一种综采面系统中的支架,其特征在于,所述支架上设置有惯性测量单元IMU以及行程传感器,所述行程传感器设置于所述支架的推杆的驱动机构上;A support in a fully mechanized mining face system, characterized in that, the support is provided with an inertial measurement unit IMU and a travel sensor, and the travel sensor is arranged on the driving mechanism of the push rod of the support;
    所述IMU用于测量所述支架的角速度信息和加速度信息,所述角速度信息和所述加速度信息用于控制设备确定所述支架的姿态角信息和位置信息;The IMU is used to measure the angular velocity information and acceleration information of the support, and the angular velocity information and the acceleration information are used to control the device to determine the attitude angle information and position information of the support;
    所述行程传感器用于测量所述支架的拉架位移信息和推溜位移信息,所述拉架位移信息和所述推溜位移信息结合所述姿态角信息和所述位置信息用于所述综采面系统中的控制设备确定所述综采面系统中刮板机上目标节点的坐标信息,所述目标节点为所述支架的推杆与所述刮板机的连接点。The stroke sensor is used to measure the frame displacement information and the push displacement information of the support, and the frame displacement information and the push displacement information are used in combination with the attitude angle information and the position information for the fully mechanized mining face The control equipment in the system determines the coordinate information of the target node on the scraper machine in the fully mechanized face system, and the target node is the connection point between the push rod of the support and the scraper machine.
  9. 根据权利要求8所述的支架,其特征在于,所述综采面系统包括支架阵列,所述支架为所述支架阵列中的一个;The support according to claim 8, wherein the fully mechanized mining face system comprises a support array, and the support is one of the support arrays;
    所述支架的姿态角信息和位置信息用于所述控制设备结合所述支架的第一目标值确定所述支架的第一调节量,所述第一调节量用于所述支架进行拉架移动,以调直所述支架阵列;The attitude angle information and position information of the support are used by the control device to determine a first adjustment amount of the support in combination with a first target value of the support, and the first adjustment amount is used for the support to perform a frame movement, to straighten the array of stents;
    所述目标节点的坐标信息用于所述控制设备结合所述目标节点的第二目标值,确定所述目标节点的第二调节量,所述第二调节量用于所述目标节点所连接的推杆在所述调直方向上进行推溜,以调直所述刮板机。The coordinate information of the target node is used by the control device to determine the second adjustment amount of the target node in combination with the second target value of the target node, and the second adjustment amount is used for the The push rod is pushed in the straightening direction to straighten the scraper.
  10. 根据权利要求8或9所述的支架,其特征在于,所述支架为液压支架、气动支架或电动支架。The support according to claim 8 or 9, characterized in that the support is a hydraulic support, a pneumatic support or an electric support.
  11. 根据权利要求8-10任一项所述的支架,其特征在于,所述IMU设置于所述支架的底座或顶梁上。The bracket according to any one of claims 8-10, wherein the IMU is arranged on a base or a top beam of the bracket.
  12. 根据权利要求8-10任一项所述的支架,其特征在于,所述IMU的一个轴的方向与所述行程传感器的朝向相同。The bracket according to any one of claims 8-10, wherein the direction of one axis of the IMU is the same as the orientation of the stroke sensor.
  13. 一种用于调直多节点设备的控制设备,其特征在于,所述控制设备包含于综采面系统,所述综采面系统还包括支架阵列和刮板机,所述支架阵列包括A个支架,其中,所述A个支架中的每个支架都通过推杆与所述刮板机连接,所述A为大于1的整数,所述控制设备包括:A control device for straightening multi-node equipment, characterized in that the control device is included in a fully mechanized mining face system, and the fully mechanized mining face system also includes a bracket array and a scraper machine, and the bracket array includes A A bracket, wherein each bracket in the A brackets is connected to the scraper machine through a push rod, the A is an integer greater than 1, and the control device includes:
    获取单元,用于获取所述支架阵列中B个支架的位置信息和姿态角信息,所述B=A,或者,所述B个支架间隔分布在所述A个支架中,所述B为正整数;An acquisition unit, configured to acquire position information and attitude angle information of B brackets in the bracket array, where B=A, or, the B brackets are distributed among the A brackets at intervals, and B is positive integer;
    处理单元,用于根据所述获取单元获取的B个支架中每个支架的位置信息和姿态角信息,以及在调直方向上所述B个支架中每个支架对应的第一目标值,确定所述B个支架中每个支架的第一调节量,和/或,根据所述B个支架中每个支架的位置信息和姿态角信息、所述B个支架中每个支架的推杆伸出的长度值,以及在所述调直方向上每个目标节点所对应的第二目标值,确定所述每个目标节点的第二调节量,所述目标节点为所述B个支架中每个支架的推杆与所述刮板机的连接点;A processing unit, configured to determine the position information and attitude angle information of each of the B brackets acquired by the acquisition unit, and the first target value corresponding to each of the B brackets in the straightening direction. The first adjustment amount of each bracket in the B brackets, and/or, according to the position information and attitude angle information of each bracket in the B brackets, the push rod of each bracket in the B brackets extends The length value of , and the second target value corresponding to each target node in the straightening direction, determine the second adjustment amount of each target node, and the target node is each bracket in the B brackets The connection point between the push rod and the scraper machine;
    发送单元,用于向所述B个支架中每个支架发送对应的所述处理单元确定的第一调节量和/或所述第二调节量,所述第一调节量用于所述B个支架中每个支架在所述调直方向上进行拉架移动,以调直所述支架阵列,所述第二调节量用于所述每个目标节点所连接的推杆在所述调直方向上进行推溜,以调直所述刮板机。A sending unit, configured to send the corresponding first adjustment amount and/or the second adjustment amount determined by the processing unit to each of the B racks, the first adjustment amount is used for the B racks Each support in the support moves in the straightening direction to straighten the support array, and the second adjustment amount is used to push the push rod connected to each target node in the straightening direction. Slide to straighten the scraper.
  14. 根据权利要求13所述的控制设备,其特征在于,所述B个支架中每个支架上都设 置有惯性测量单元IMU以及行程传感器,所述行程传感器设置于所述推杆的驱动机构上;The control device according to claim 13, wherein an inertial measurement unit (IMU) and a stroke sensor are arranged on each of the B brackets, and the stroke sensor is arranged on the driving mechanism of the push rod;
    所述IMU用于测量所述支架的角速度信息和加速度信息,所述角速度信息和所述加速度信息用于控制设备确定所述支架的姿态角信息和位置信息;The IMU is used to measure the angular velocity information and acceleration information of the support, and the angular velocity information and the acceleration information are used to control the device to determine the attitude angle information and position information of the support;
    所述行程传感器用于测量所述支架的拉架位移信息和推溜位移信息,所述拉架位移信息和所述推溜位移信息结合所述姿态角信息和所述位置信息用于所述控制设备确定所述刮板机上所述目标节点的坐标信息。The stroke sensor is used to measure the frame displacement information and the push displacement information of the support, and the frame displacement information and the push displacement information are combined with the attitude angle information and the position information for the control device to determine Coordinate information of the target node on the scraper.
  15. 根据权利要求13或14所述的控制设备,其特征在于,A control device as claimed in claim 13 or 14, characterized in that
    所述处理单元用于:The processing unit is used for:
    确定所述B个支架中每个支架在所述调直方向上的位置信息,与所述B个支架中每个支架在所述调直方向上所对应的所述第一目标值的第一差值;determining the first difference between the position information of each of the B brackets in the straightening direction and the first target value corresponding to each of the B brackets in the straightening direction ;
    将所述B个支架中每个支架的所述第一差值,与所述B个支架中每个支架在所述调直方向上的余弦数据的商确定为所述第一调节量;Determining the quotient of the first difference of each of the B brackets and the cosine data of each of the B brackets in the straightening direction as the first adjustment amount;
    其中,所述余弦数据包括第一余弦,或者,所述第一余弦与所述第二余弦和所述第三余弦中至少一个的乘积,所述第一余弦为所述B个支架中每个支架在所述调直方向上的航向角的余弦,所述第二余弦为所述B个支架中每个支架在所述调直方向上的横滚角的余弦,所述第三余弦为所述B个支架中每个支架在所述调直方向上的俯仰角的余弦,所述航向角、所述横滚角,所述俯仰角包含于所述B个支架中每个支架的姿态角信息中。Wherein, the cosine data includes the first cosine, or the product of the first cosine and at least one of the second cosine and the third cosine, and the first cosine is the B The cosine of the yaw angle of each bracket in the B brackets in the straightening direction, the second cosine is the cosine of the roll angle of each bracket in the B brackets in the straightening direction, and the second cosine is the cosine of the roll angle of each bracket in the B brackets in the straightening direction. The three cosines are the cosines of the pitch angle of each bracket in the B brackets in the straightening direction, the heading angle, the roll angle, and the pitch angle are included in each of the B brackets In the attitude angle information of the bracket.
  16. 根据权利要求13-15任一项所述的控制设备,其特征在于,A control device according to any one of claims 13-15, characterized in that,
    所述处理单元还用于:The processing unit is also used for:
    根据所述B个支架中每个支架在所述调直方向上的位置信息,确定第一曲线,所述第一曲线用于描述所述B个支架在所述调直方向上的位置分布;Determining a first curve according to the position information of each bracket in the B brackets in the straightening direction, the first curve is used to describe the position distribution of the B brackets in the straightening direction;
    若所述第一曲线中在调直方向上的最大波峰值或者最大波谷值超出第一阈值,或者所述最大波峰值与所述最大波谷值的差值超出第二阈值,则执行确定所述第一调节量的步骤。If the maximum peak value or the maximum valley value in the straightening direction in the first curve exceeds a first threshold, or the difference between the maximum peak value and the maximum valley value exceeds a second threshold, then perform determination of the first curve. A volume adjustment step.
  17. 根据权利要求13或14所述的控制设备,其特征在于,A control device as claimed in claim 13 or 14, characterized in that
    所述处理单元用于:The processing unit is used for:
    根据所述B个支架中每个支架的位置信息,以及所述B个支架中每个支架的推杆伸出的长度值,以及所述B个支架中每个支架的姿态角信息,确定每个目标节点的坐标信息;According to the position information of each bracket in the B brackets, and the length value of the push rod of each bracket in the B brackets, and the attitude angle information of each bracket in the B brackets, determine each Coordinate information of a target node;
    确定所述每个目标节点的在所述调直方向上的坐标信息,与在所述调直方向上所述每个目标节点所对应的第二目标值的第二差值;determining a second difference between the coordinate information of each target node in the straightening direction and a second target value corresponding to each target node in the straightening direction;
    将所述每个目标节点所对应的所述第二差值,与所述每个目标节点在所述调直方向上的余弦数据的商确定为所述第二调节量;determining the quotient of the second difference corresponding to each target node and the cosine data of each target node in the straightening direction as the second adjustment amount;
    其中,所述余弦数据包括第四余弦,或者,所述第四余弦与所述第五余弦和所述第六余弦中至少一个的乘积,所述第四余弦为所述每个目标节点所连接的推杆在所述调直方向上的航向角的余弦,所述第五余弦为所述每个目标节点所连接的推杆在所述调直方向上的横滚角的余弦,所述第六余弦为所述每个目标节点所连接的推杆在所述调直方向上的俯仰角的余弦,所述航向角、所述横滚角,所述俯仰角包含于所述每个目标节点所连接的推杆的姿态角信息中,所述每个目标节点所连接的推杆的姿态角信息为所述推杆所在的支架的 姿态角信息。Wherein, the cosine data includes the fourth cosine, or the product of the fourth cosine and at least one of the fifth cosine and the sixth cosine, and the fourth cosine is the product of each The cosine of the heading angle of the push rod connected to each target node in the straightening direction, and the fifth cosine is the cosine of the roll angle of the push rod connected to each target node in the straightening direction , the sixth cosine is the cosine of the pitch angle of the push rod connected to each target node in the straightening direction, the heading angle, the roll angle, and the pitch angle are included in the In the attitude angle information of the push rod connected to each target node, the attitude angle information of the push rod connected to each target node is the attitude angle information of the bracket where the push rod is located.
  18. 根据权利要求17所述的控制设备,其特征在于,A control device according to claim 17, characterized in that
    所述处理单元还用于:The processing unit is also used for:
    根据每个目标节点的坐标信息,确定第二曲线,所述第二曲线用于描述所述每个目标节点在所述调直方向上的位置分布;determining a second curve according to the coordinate information of each target node, where the second curve is used to describe the position distribution of each target node in the straightening direction;
    若所述第二曲线中在调直方向上的最大波峰值或者最大波谷值超出第三阈值,或者所述最大波峰值与所述最大波谷值的差值超出第四阈值,则执行确定所述第二调节量的步骤。If the maximum peak value or the maximum valley value in the straightening direction in the second curve exceeds a third threshold, or the difference between the maximum peak value and the maximum valley value exceeds a fourth threshold, then perform determination of the first Two steps to adjust the volume.
  19. 根据权利要求13-18任一项所述的控制设备,其特征在于,A control device according to any one of claims 13-18, characterized in that,
    所述处理单元还用于:根据所述B个支架中每个支架在所述调直方向上的航向角的测量值,以及在所述调直方向上的所述航向角的目标值,确定所述B个支架中每个支架的所述航向角的补偿值;The processing unit is further configured to: according to the measured value of the heading angle of each of the B brackets in the straightening direction, and the target value of the heading angle in the straightening direction, determine the The compensation value of the heading angle of each bracket in the B brackets;
    所述发送单元,还用于向所述B个支架中每个支架的相邻支架发送对应航向角的补偿值,所述航向角的补偿值用于所述相邻支架调整所述B个支架中每个支架位置,以将所述B个支架中每个支架调整到所述航向角的目标值。The sending unit is further configured to send a compensation value corresponding to a heading angle to an adjacent bracket of each bracket in the B brackets, and the compensation value of the heading angle is used for the adjacent brackets to adjust the B brackets Each bracket position in the B brackets is used to adjust each bracket in the B brackets to the target value of the heading angle.
  20. 一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被一个或多个处理器执行时实现如权利要求1-7任一项所述的方法。A computer-readable storage medium on which a computer program is stored, wherein the computer program implements the method according to any one of claims 1-7 when executed by one or more processors.
  21. 一种控制设备,其特征在于,包括一个或多个处理器和存储有计算机程序的计算机可读存储介质;A control device, characterized by comprising one or more processors and a computer-readable storage medium storing a computer program;
    所述计算机程序被所述一个或多个处理器执行时实现如权利要求1-7任一项所述的方法。The computer program implements the method according to any one of claims 1-7 when executed by the one or more processors.
  22. 一种芯片系统,其特征在于,包括一个或多个处理器,所述一个或多个处理器被调用用于执行如权利要求1-7任一项所述的方法。A chip system, characterized by comprising one or more processors, and the one or more processors are invoked to execute the method according to any one of claims 1-7.
  23. 一种计算机程序产品,其特征在于,包括计算机程序,所述计算机程序当被一个或多个处理器执行时用于实现如权利要求1-7任一项所述的方法。A computer program product, characterized by comprising a computer program, the computer program is used to implement the method according to any one of claims 1-7 when executed by one or more processors.
  24. 一种综采面系统,其特征在于,包括支架阵列、刮板机、采煤机和控制设备,所述支架阵列包括A个支架,其中,所述A个支架中的每个支架都通过推杆与所述刮板机连接,所述采煤机在所述刮板机上运行,所述A为大于1的整数,所述控制设备用于执行上述权利要求1-7任一项所述的方法。A fully mechanized mining face system, characterized in that it includes a bracket array, a scraper machine, a shearer and control equipment, the bracket array includes A brackets, wherein each bracket in the A brackets is pushed The rod is connected with the scraper machine, the coal shearer runs on the scraper machine, the A is an integer greater than 1, and the control device is used to implement the method described in any one of claims 1-7. method.
PCT/CN2022/133608 2022-01-29 2022-11-23 Straightening method for multi-node device and corresponding device WO2023142631A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202210111713.X 2022-01-29
CN202210111713.XA CN116558508A (en) 2022-01-29 2022-01-29 Straightening method of multi-node equipment and corresponding equipment

Publications (1)

Publication Number Publication Date
WO2023142631A1 true WO2023142631A1 (en) 2023-08-03

Family

ID=87470440

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/133608 WO2023142631A1 (en) 2022-01-29 2022-11-23 Straightening method for multi-node device and corresponding device

Country Status (2)

Country Link
CN (1) CN116558508A (en)
WO (1) WO2023142631A1 (en)

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104058215A (en) * 2014-06-05 2014-09-24 中国矿业大学 Scrapping plate conveyor dynamic straightening method based on absolute motion trajectory of coal cutter
CN109751070A (en) * 2018-12-29 2019-05-14 中国矿业大学 Hydraulic support and its detection method based on IMU real-time monitoring supporting pose
CN110319831A (en) * 2019-05-23 2019-10-11 北斗天地股份有限公司山东分公司 A kind of working face cut-off method
CN111442759A (en) * 2020-03-05 2020-07-24 天地科技股份有限公司 Combine and adopt unified monitoring system of working face equipment position appearance
DE102020103790A1 (en) * 2019-02-14 2020-08-20 Caterpillar Paving Products Inc. TRAVEL CONTROL SYSTEMS AND METHODS FOR CONSTRUCTION MACHINERY USING A LIFT CYLINDER CONTROL
CN111927518A (en) * 2020-09-10 2020-11-13 西安科技大学 Automatic straightening method for fully mechanized coal mining face hydraulic support based on combination of inertial navigation and odometer
CN112431635A (en) * 2021-01-28 2021-03-02 北京龙软科技股份有限公司 Automatic alignment method, device and system for fully mechanized coal mining face based on geodetic coordinate sequence
CN113790075A (en) * 2021-09-07 2021-12-14 中煤科工开采研究院有限公司 Multi-dimensional positioning system and method for hydraulic support of working face

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104058215A (en) * 2014-06-05 2014-09-24 中国矿业大学 Scrapping plate conveyor dynamic straightening method based on absolute motion trajectory of coal cutter
CN109751070A (en) * 2018-12-29 2019-05-14 中国矿业大学 Hydraulic support and its detection method based on IMU real-time monitoring supporting pose
DE102020103790A1 (en) * 2019-02-14 2020-08-20 Caterpillar Paving Products Inc. TRAVEL CONTROL SYSTEMS AND METHODS FOR CONSTRUCTION MACHINERY USING A LIFT CYLINDER CONTROL
CN110319831A (en) * 2019-05-23 2019-10-11 北斗天地股份有限公司山东分公司 A kind of working face cut-off method
CN111442759A (en) * 2020-03-05 2020-07-24 天地科技股份有限公司 Combine and adopt unified monitoring system of working face equipment position appearance
CN111927518A (en) * 2020-09-10 2020-11-13 西安科技大学 Automatic straightening method for fully mechanized coal mining face hydraulic support based on combination of inertial navigation and odometer
CN112431635A (en) * 2021-01-28 2021-03-02 北京龙软科技股份有限公司 Automatic alignment method, device and system for fully mechanized coal mining face based on geodetic coordinate sequence
CN113790075A (en) * 2021-09-07 2021-12-14 中煤科工开采研究院有限公司 Multi-dimensional positioning system and method for hydraulic support of working face

Also Published As

Publication number Publication date
CN116558508A (en) 2023-08-08

Similar Documents

Publication Publication Date Title
CN109018851B (en) Real-time monitoring method for three-dimensional space operation attitude position of scraper conveyor
CN111442759B (en) Unified monitoring system for pose of fully-mechanized coal mining face equipment
CN102431784B (en) Attitude control system and method based on wireless three-dimensional gyroscope technology for scraper conveyer
JP2021504140A (en) Methods and systems using smart torches with position tracking in robot welding
CN101072916B (en) Method and device for monitoring a road processing machine
US11156454B2 (en) Measurement system and machine for folding an object
CN108957405A (en) A kind of detection method of coal face scraper conveyor straightness
CN105264335B (en) Disembark formula air navigation aid and the equipment of robot device
CN111441812B (en) Coal mine fully mechanized coal mining face automatic straightening system and method based on inertial navigation system
CN104058215A (en) Scrapping plate conveyor dynamic straightening method based on absolute motion trajectory of coal cutter
CN110319831B (en) Working face straightening method
CN102606165A (en) Automatic deviation rectifying system for shield machine and operating method of automatic deviation rectifying system
WO2023142631A1 (en) Straightening method for multi-node device and corresponding device
CN103587719A (en) Full-automatic drilling and riveting positioning method of flat workpiece
WO2023232042A1 (en) Vision-based automatic straightening control system and method for hydraulic support of fully mechanized mining face
CN104070406A (en) Device and method for compensating composition error of main shaft in real time
CN113738390B (en) Time-sharing migration space attitude fine-adjustment deviation-rectifying method of rectangular pipe jacking machine
CN108506711B (en) Sintering machine trolley wheel greasing track detection device, control system and control method
CN113914880B (en) Tunnel punching method capable of correcting inclination angle based on laser ranging and punching robot
CN109916346B (en) Workpiece flatness detection device and method based on vision system
CN115788438B (en) Method and device for adjusting fully-mechanized coal mining face
CN113420403A (en) Movement planning method for pushing mechanism of hydraulic support and scraper conveyor
CN102818557A (en) Automatic pose measuring device and engineering machine
CN110815219B (en) Trajectory tracking method and device, electronic equipment and storage medium
CN110682287B (en) Robot and control device

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22923424

Country of ref document: EP

Kind code of ref document: A1