Method and system for determining grabbing pose of vehicle-mounted container and storage medium

By setting position sensors, ranging sensors and counter-light gratings on the railway transport vehicle, the arrival corner point and rotation angle of the container are determined, and the problems of inaccurate positioning and insufficient stability in the prior art are solved, achieving efficient and accurate The container grab position is determined, which improves transportation safety and equipment efficiency.

CN119017376APending Publication Date: 2024-11-26HENAN RONGSHI HEAVY EQUIPMENT CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411048700.8
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2024-07-02
Filing Date
2024-08-01
Publication Date
2024-11-26

AI Technical Summary

Technical Problem

In the prior art, the position positioning method of railway transportation containers has problems such as large amount of data, long calculation time, serious environmental pollution, and insufficient stability. There is a large error when determining the container position through the train position, resulting in safety hazards such as failure of lifting.

Method used

The position sensor and distance measuring sensor are set in the direction of the transport vehicle. Combined with the target grating, the arrival corner point and rotation angle of the container are determined through the detection results, and the position coordinates of the arrival corner point are determined after the transport vehicle stops, and then the container is determined. grab position.

Benefits of technology

It realizes container positioning with accurate position and high efficiency, reduces equipment operation losses and errors, and improves the grab success rate and equipment stability.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119017376A_ABST
    Figure CN119017376A_ABST
Patent Text Reader

Abstract

The invention relates to a method, a storage medium and a system for determining a grabbing pose of a vehicle-mounted container, which combines a position sensor, a distance measuring sensor and a correlation grating, firstly determines a container, an arrival angular point and a rotating pose, then determines the position coordinate of the arrival angular point, and finally determines the grabbing pose of the vehicle-mounted container according to the position coordinate of the arrival angular point and the rotating angle of the container. And the grabbing posture of the container is determined. The step S1 is a preparation stage; s2, firstly determining the arrival angular point and the rotation angle of the container, which is equivalent to coarse positioning, and at the moment, preliminarily determining the arrival time of the container and positioning the approximate pose of the container through a position sensor and a distance measuring sensor to make preparations for subsequent fine positioning; according to the further step S3, the position coordinates of the arriving angular points can be determined through the correlation grating, which is equivalent to precise positioning, errors caused by the fact that the position of the container is determined simply through the position of a traction machine can be overcome, follow-up grabbing failures are avoided, the working efficiency can be improved, the energy loss of grabbing equipment is reduced, and the stability of the equipment is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of control, and in particular to a method for determining a grabbing posture of a vehicle-mounted container. Background Art

[0002] Take the railway transport container as an example. When it arrives at the transfer location, it needs to locate its position first, and then transfer it by the lifting device. In the existing technology, one is to obtain information such as the location of the container visually. The data is collected by the 3D laser radar gimbal. This solution not only has a large amount of data, a long calculation time, and wastes production time, but also has serious dust pollution in the working environment. The power device of the gimbal is not stable enough, resulting in slow data collection or even deviations. Similarly, other visual algorithms such as cameras are also greatly affected by light, dust and background environment. For high-condition position detection, the stability is insufficient, resulting in failure of the lifting device to grab in the later stage, and even safety hazards. The second method is to determine the position of the container through the position of the transport carrier, such as a train or other tractor. However, due to the large gap between the train traction hook itself, there is an error in using the position of the train tractor to determine the position of the container carried by the towed vehicle. The positioning is largely inaccurate, resulting in subsequent capture failures. Announcement No. CN117537714B discloses a method for detecting the position of railway transport containers. On this basis, this solution also adds a laser sensor to the container lifting device to secondary position the container. The secondary positioning requires the container lifting device to move back and forth, which increases operating costs and equipment operating losses, and takes up work cycle time, resulting in low efficiency.

[0003] Therefore, how to provide an accurate and efficient positioning method is a technical problem that needs to be solved urgently in this field. Summary of the invention

[0004] In order to solve at least one of the above technical problems, the present invention provides a method for determining a grabbing posture of a vehicle-mounted container, comprising:

[0005] A position sensor is provided in the direction of travel of the transport vehicle;

[0006] A distance measuring sensor and a beam grating are arranged on the side of the transport vehicle in the direction of travel; the distance measuring sensor is arranged at the front end of the parking area; and the beam grating is arranged in the parking area;

[0007] When the transport vehicle is moving, the arrival angle and rotation angle of the container are determined based on the detection results of the position sensor and the distance sensor;

[0008] After the transport vehicle stops, the position coordinates of the corner point are determined based on the detection results of the beam grating;

[0009] The container grabbing posture is determined based on the position coordinates and rotation angle of the arrival corner point.

[0010] Furthermore, the step of determining the arrival angle and rotation angle of the container includes:

[0011] According to the detection results of the distance measuring sensor, it is judged whether the container has arrived, so as to determine the arrival time of the container;

[0012] Get the first position x of the position sensor at the first moment 1 The first distance y from the distance measuring sensor 1 ; At the second moment, obtain the second position x of the position sensor 2 The second distance y from the distance measuring sensor 2 , and determine the arrival angle and rotation angle of the container accordingly; the arrival time ≤ the first time < the second time.

[0013] Further, according to the first distance y 1 and the second distance y 2 The size change determines the arrival angle and rotation direction of the container.

[0014] Furthermore, if the first distance y 1 Less than the second distance y 2 , the container rotates clockwise for a certain angle, and the corner point reached is the upper right corner of the container; if the first distance y 1 Greater than the second distance y 2 , the container rotates counterclockwise for a certain angle, and the corner point reached is the lower right corner of the container; if the first distance y 1 Equal to the second distance y 2 , the container does not deviate and the arrival corner is the lower right corner of the container.

[0015] Furthermore, the distance measuring sensor is arranged in a direction perpendicular to the traveling direction of the transport vehicle.

[0016] Furthermore, according to formula (1), the rotation angle of the container is determined:

[0017]

[0018] Furthermore, a distance measuring sensor is arranged 1-5 m in front of the parking area; and a corresponding light barrier is arranged in the central area of ​​the parking area.

[0019] Furthermore, the center point of the container is calculated according to the position coordinates of the corner points; the center point is used as the grasping position, and the rotation angle is used as the grasping angle to determine the grasping posture.

[0020] On the other hand, the present invention also provides a computer-readable storage medium, characterized in that a computer program for executing any of the above-mentioned grasping posture determination methods is stored thereon.

[0021] On the other hand, the present invention also provides a computer system, comprising any of the above-mentioned computer-readable storage media and one or more processors;

[0022] The processor is configured to run the computer program. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] Figure 1 A flowchart of an embodiment of a method for determining a grasping posture of the present invention;

[0024] Figure 2 A schematic diagram of an embodiment of a container travel process;

[0025] Figure 3 A schematic diagram of another embodiment of a container traveling process;

[0026] Figure 4 Schematic diagram of the distance sensor setup. DETAILED DESCRIPTION

[0027] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0028] It should be noted that if the embodiments of the present invention involve directional indications, such as up, down, left, right, front, back, etc., then the directional indication is only used to explain the relative position relationship, movement status, etc. between the components in a certain specific posture. If the specific posture changes, the directional indication will also change accordingly. In addition, if the embodiments of the present invention involve descriptions of "first, second", "S1, S2", "step one, step two", etc., then such descriptions are only used for descriptive purposes and cannot be understood as indicating or implying their relative importance or implicitly indicating the number of indicated technical features or indicating the execution order of the method, etc. Those skilled in the art can understand that anything that does not violate the gist of the invention under the technical concept of the invention should be included in the protection scope of the present invention.

[0029] like Figure 1 As shown, the present invention provides a method for determining a grabbing posture of a vehicle-mounted container, comprising:

[0030] S1: Preparation

[0031] A position sensor is provided in the direction of travel of the transport vehicle;

[0032] A distance measuring sensor and a beam grating are arranged on the side of the transport vehicle in the direction of travel; the distance measuring sensor is arranged at the front end of the parking area; and the beam grating is arranged in the parking area;

[0033] Preferably, Figure 2 As shown, the transport vehicle can be optionally but not limited to a train, with its traveling direction as the X-axis, and a train traction device 2 with position detection is arranged at its front end, preferably a position sensor, an encoder, etc., to detect the real-time position of the train; a plurality of carriages are arranged at the rear end, Figure 2 Two carriages are shown, with two containers placed on each carriage.

[0034] More preferably, Figure 2 As shown, at the front end of the parking area, such as the container lifting and processing area, the transfer area, the inspection area, etc., a distance sensor 1 is set to detect the distance between it and the container; the distance sensor is preferably set in the vertical direction of the train travel direction, such as Figure 4 More preferably, the position of the distance measuring sensor 1 is taken as the coordinate origin O, the direction of the train travel is taken as the X axis, and the vertical direction is taken as the Y axis; more preferably, in the parking area, such as the container lifting and processing area, the transfer area, the inspection area, etc., a beam grating 3 is set to know whether there is a container at the position by whether the grating is penetrated, and determine the position of the container.

[0035] Detection phase:

[0036] S2: When the transport vehicle is moving, the arrival angle and rotation angle of the container are determined according to the detection results of the position sensor and the distance sensor;

[0037] Specifically, they include:

[0038] S21: judging whether the container has arrived according to the detection result of the distance measuring sensor, so as to determine the arrival time of the container;

[0039] Specifically, Figure 2As shown, during the train's advance, if the container has not reached the position that the ranging sensor can sense, that is, when there is no container at the front of the ranging sensor, the signal sent by the ranging sensor will only return a signal after sensing a distant obstacle, and the distance is bound to be relatively far; and as the train continues to move forward, when the container it tows reaches the position that the ranging sensor can sense, that is, when there is a container at the front of the ranging sensor, the signal sent by the ranging sensor touches the container and returns a signal, and the distance is bound to be relatively close; therefore, the arrival time of the container can be determined based on the extreme change of the distance signal of the ranging sensor. Preferably, it is optional: when the detection result of the ranging sensor decreases sharply, the moment is determined to be the arrival time of the container; or when the normal container arrives, the distance of the container detected is used as the reference value, and a certain distance above and below the reference value is used as the range, such as 5±0.5m, and the moment when the distance within the range is detected is determined as the arrival time of the container.

[0040] S22: Obtaining the first position x of the position sensor at the first moment 1 The first distance y from the distance measuring sensor 1 ; At the second moment, obtain the second position x of the position sensor 2 The second distance y from the distance measuring sensor 2 , and determine the arrival angle and rotation angle of the container accordingly; arrival time ≤ first time < second time;

[0041] Preferably, at the arrival time, the first position x of the position sensor is obtained. 1 The first distance y from the distance measuring sensor 1 ; At the second moment after the arrival moment, obtain the second position x of the position sensor 2 The second distance y from the distance measuring sensor 2 ; Specifically, the second moment may be a short period of time after the arrival moment, such as several minutes later.

[0042] More specifically, Figure 2 As shown, at the arrival moment, the point on the container sensed by the ranging sensor must be a corner point of the container in the forward direction, that is, the first point that first enters the sensing range of the ranging sensor is regarded as the arrival corner point.

[0043] by Figure 2 Taking the train traction direction shown as an example, if the container has no offset angle or is offset counterclockwise, the first point that enters the sensing range of the ranging sensor is the corner point at the lower right corner of the first container; if the container is offset clockwise, the corner point at the upper right corner of the first container is detected;

[0044] Preferably, optionally: according to the first distance y 1 and the second distance y2 The arrival angle and rotation direction of the container are determined by the size change;

[0045] by Figure 2 As an example, if the first distance y 1 Less than the second distance y 2 , the container deviates downward, that is, rotates clockwise by a certain angle, and then its arrival corner is the upper right corner; if the first distance y 1 Greater than the second distance y 2 , the container is offset upward, that is, it rotates counterclockwise by a certain angle, and then its arrival corner is the lower right corner; if the first distance y 1 Equal to the second distance y 2 , the container does not deviate, that is, the rotation angle is 0; of course, the size changes, the first distance y 1 The second distance y 2 Directly determine by difference, or determine by ratio, etc.; in this process, the arrival time can be determined, and which corner point of the container is the first arrival point, that is, the arrival corner point.

[0046] More specifically, the first position x 1 , then the horizontal coordinate of the corner point can be determined by transformation; if the distance measuring sensor is set in the vertical direction of the train's forward direction, such as Figure 2 Taking the XY axis shown in FIG. 1 as an example, the first distance y 1 , which is the arrival time, that is, the ordinate of the first corner point detected. If the distance measuring sensor is only set on the side of the train's forward direction, not vertically, but at an angle, then the first distance y 1 A cosine transform is required to obtain the ordinate of the first corner point detected.

[0047] Preferably, the distance measuring sensor is arranged in a direction perpendicular to the forward direction of the train, and the rotation angle of the container can be determined optionally but not limited to according to formula (1):

[0048]

[0049] More preferably, Figure 2 As shown, the train includes two carriages, each of which has two containers. Then, the arrival angle and the rotation angle of the second container and the two containers in the second carriage can be determined according to the above process.

[0050] S3: After the transport vehicle stops, the position coordinates of the corner point are determined according to the detection results of the beam grating;

[0051] Specifically, it is optional but not limited to the arrival time of the container determined in step S21, or the first position x of the position sensor obtained in step S22.1 or / and the second position x 2 , and it is expected that after a period of time, the transport vehicle will be controlled to stop and the container will be parked in an area where a beam grating is set, such as Figure 3 The container lifting and handling area is shown.

[0052] At this time, according to the detection result of the opposing grating, such as which position of the grating just detects the container, the position coordinates can be determined according to the known installation position of the opposing grating, that is, the position coordinates of the arrival corner point determined in step S2.

[0053] S4: Determine the grabbing posture of the container according to the position coordinates and rotation angle of the arrival corner point.

[0054] Specifically, the coordinates of the center point of the container can be calculated based on the position coordinates of the arrival corner point and the size of the container; the center point coordinates are used as the grasping position and the rotation angle is used as the grasping angle to determine the grasping posture.

[0055] In this embodiment, a method for determining the grabbing posture of a vehicle-mounted container of the present invention is provided, which combines a position sensor, a distance measuring sensor and a beam grating, first determines the container and the arrival corner point and the rotation posture, then determines the position coordinates of the arrival corner point, and finally determines the grabbing posture of the container according to the position coordinates of the arrival corner point and the rotation angle of the container. Step S1 is the preparation stage; step S2, first determines the arrival corner point and the rotation angle of the container, which is equivalent to rough positioning. At this time, the arrival time of the container can be preliminarily determined through the position sensor and the distance measuring sensor, and the approximate posture of the container can be located, in preparation for subsequent precise positioning; further step S3, through the beam grating, can determine the position coordinates of the arrival corner point, which is equivalent to precise positioning, can overcome the error caused by simply determining the position of the container by the position of the tractor, avoid subsequent grabbing failures, can improve work efficiency, reduce the energy consumption of the grabbing equipment, and improve equipment stability.

[0056] On the other hand, the present invention also provides a computer storage medium storing executable program code; the executable program code is used to execute any of the above-mentioned grasping posture determination methods.

[0057] On the other hand, the present invention also provides a terminal device, including a memory and a processor; the memory stores program codes that can be executed by the processor; the program codes are used to execute any of the above-mentioned grasping posture determination methods.

[0058] Exemplarily, the program code may be divided into one or more modules / units, which are stored in the memory and executed by the processor to complete the present invention. The one or more modules / units may be a series of computer program instruction segments capable of completing specific functions, which are used to describe the execution process of the program code in the terminal device.

[0059] The terminal device may be a computing device such as a desktop computer, a notebook, a PDA, a cloud server, etc. The terminal device may include, but is not limited to, a processor and a memory. Those skilled in the art will appreciate that the terminal device may also include an input / output device, a network access device, a bus, etc.

[0060] The processor may be a central processing unit (CPU), or other general-purpose processors, digital signal processors (DSP), application-specific integrated circuits (ASIC), field-programmable gate arrays (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components, etc. A general-purpose processor may be a microprocessor or any conventional processor, etc.

[0061] The memory may be an internal storage unit of the terminal device, such as a hard disk or a memory. The memory may also be an external storage device of the terminal device, such as a plug-in hard disk, a smart memory card (SmartMedia Card, SMC), a secure digital (Secure Digital, SD) card, a flash card (Flash Card), etc. equipped on the terminal device. Further, the memory may also include both an internal storage unit of the terminal device and an external storage device. The memory is used to store the program code and other programs and data required by the terminal device. The memory may also be used to temporarily store data that has been output or is to be output.

[0062] The above-mentioned computer storage medium and terminal device are created based on the above-mentioned grasping posture determination method. Its technical role and beneficial effects are not repeated here. The technical features of the above-mentioned embodiments can be combined arbitrarily. In order to make the description concise, all possible combinations of the various technical features in the above-mentioned embodiments are not described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification. The above-mentioned embodiments only express several implementation methods of the present invention, and the description is relatively specific and detailed, but it cannot be understood as a limitation on the scope of the invention patent. It should be pointed out that for ordinary technicians in this field, without departing from the concept of the present invention, several variations and improvements can be made, which all belong to the scope of protection of the present invention.

Claims

1. A method for determining the grabbing posture of a vehicle-mounted container, characterized in that: include: A position sensor is provided in the direction of travel of the transport vehicle; A distance measuring sensor and a beam grating are arranged on the side of the transport vehicle in the direction of travel; The distance measuring sensor is arranged at the front end of the parking area; the beam grating is arranged in the parking area; When the transport vehicle is moving, the arrival angle and rotation angle of the container are determined based on the detection results of the position sensor and the distance sensor; After the transport vehicle stops, the position coordinates of the corner point are determined based on the detection results of the beam grating; The container grabbing posture is determined based on the position coordinates and rotation angle of the arrival corner point.

2. The method for determining grasping posture according to claim 1, characterized in that: The steps of determining the arrival angle and rotation angle of the container include: According to the detection results of the distance measuring sensor, it is judged whether the container has arrived, so as to determine the arrival time of the container; At the first moment, the first position x1 of the position sensor and the first distance y1 of the distance measuring sensor are obtained; at the second moment, the second position x2 of the position sensor and the second distance y2 of the distance measuring sensor are obtained, and the arrival angle and the rotation angle of the container are determined accordingly; the arrival moment ≤ the first moment < the second moment.

3. The method for determining grasping posture according to claim 2, characterized in that: According to the change in the first distance y1 and the second distance y2, the arrival angle point and the rotation direction of the container are determined.

4. The method for determining grasping posture according to claim 3, characterized in that: If the first distance y1 is less than the second distance y2, the container rotates a certain angle in a clockwise direction, and the corner point reached is the upper right corner of the container; if the first distance y1 is greater than the second distance y2, the container rotates a certain angle in a counterclockwise direction, and the corner point reached is the lower right corner of the container; if the first distance y1 is equal to the second distance y2, the container is not offset, and the corner point reached is the lower right corner of the container.

5. The method for determining grasping posture according to claim 4, characterized in that: The distance measuring sensor is arranged in a direction perpendicular to the traveling direction of the transport vehicle.

6. According to the grasping posture determination method of claim 5, the rotation angle of the container is determined according to formula (1):

7. According to the grasping posture determination method of claim 6, the ranging sensor is set 1-5m in front of the parking area; the reflected light barrier is set in the central area of ​​the parking area.

8. The method for determining grasping posture according to any one of claims 1 to 7, characterized in that: According to the position coordinates of the corner points, the coordinates of the center point of the container are calculated; the coordinates of the center point are used as the grasping position, and the rotation angle is used as the grasping angle to determine the grasping posture.

9. A computer-readable storage medium, characterized in that: A computer program for executing the grasping posture determination method according to any one of claims 1 to 8 is stored thereon.

10. A computer system, characterized in that: comprising the computer-readable storage medium of claim 9 and one or more processors; The processor is configured to run the computer program.