Laser positioning method for port vehicle, computer equipment and storage medium

By using laser positioning for port vehicles and maintaining sub-maps for positioning in real time, the problem of long laser positioning time in traditional port unmanned driving is solved, improving positioning accuracy and efficiency, and enhancing container handling efficiency.

CN119022933AActive Publication Date: 2024-11-26SHANGHAI ZHENHUA HEAVY IND

Patent Information

Application Number
CN202411150938.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-21
Publication Date
2024-11-26
Estimated Expiration
2044-08-21

AI Technical Summary

Technical Problem

In traditional port unmanned driving technology, laser positioning requires the establishment, real-time maintenance and updating of a global point cloud map, which is time-consuming and results in low container handling efficiency.

Method used

The laser positioning method for port vehicles is adopted. By determining the initial real-time pose and sub-map position of the port vehicles, the sub-map is maintained in real time, reducing the time for map building and data acquisition. The sub-map is generated using laser point clouds for positioning.

Benefits of technology

It reduces the difficulty of laser positioning operations, improves the accuracy and efficiency of positioning, reduces data collection time, and improves container handling efficiency.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119022933A_ABST
    Figure CN119022933A_ABST
Patent Text Reader

Abstract

The invention provides a laser positioning method of a port vehicle, computer equipment and a storage medium, the port vehicle comprises a laser positioning sensor, and the laser positioning method comprises the following steps: determining a space coordinate system where the port vehicle is located, and determining an initial value of a pose of the port vehicle in the space coordinate system; the laser point cloud of the port vehicle is collected in real time, and the laser point cloud of the port vehicle at the current moment and the laser point cloud of the port vehicle at the previous moment are preprocessed. And performing inter-frame matching on the preprocessed two frames of laser point clouds to obtain a pose conversion value, and obtaining a real-time pose initial value based on the pose conversion value and the initial value. And selecting a plurality of laser point clouds as key frame point clouds, generating a sub-map, and obtaining a port vehicle laser positioning result. By determining the real-time pose initial value of the port vehicle and the position of the port vehicle in the sub-map, laser positioning of the port vehicle is realized, real-time maintenance of a global laser point cloud map is avoided, and the laser positioning efficiency is improved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the technical field of laser positioning, and in particular to a laser positioning method, computer equipment and storage medium for port vehicles. Background Art

[0002] With the continuous development of port logistics business, the efficiency requirements for container handling are gradually increasing. Traditional manned truck solutions can no longer meet the port container handling needs due to objective reasons such as high labor costs and low work efficiency. Therefore, relevant unmanned driving technologies need to be put into practical use in automated terminals. Among them, unmanned driving technology solutions represented by smart guided vehicles have been widely used in automated terminal handling tasks.

[0003] Compared with unmanned driving technology scenarios such as smart warehousing, smart parks and indoor cleaning, the automated handling scenarios in ports have more stringent requirements for unmanned driving technology. The main factors include two points. First, in addition to engineering vehicles, there are also handling vehicles from external merchants inside the port, so the port is an open environment. Secondly, the environmental characteristics of the terminal are dynamic (that is, the terminal has heavy mobile equipment such as quay cranes, rail cranes and tire cranes), the operating area is large, and the working conditions are complex. In addition, the port climate is relatively harsh. For example, under conditions such as heavy rain, scorching sun, dust and night work, it is a great challenge to the performance of vehicle-mounted equipment.

[0004] The current unmanned driving technology solution for ports is mainly based on simultaneous localization and mapping (SLAM). This solution requires pre-collection of environmental data, offline generation of point cloud maps, and then matching of real-time scanned laser point cloud data and point cloud maps, and combining other sensor data to obtain the final positioning result. However, in the automated handling tasks of ports, the physical position and shape of quay cranes, rail cranes and containers will change, so it is necessary to maintain and update the point cloud map in real time, which is complicated and inefficient. The open environment and large working area of ​​the port make the matching of laser data and point cloud maps poor, the positioning results are low in accuracy, and the stability is reduced. For the pre-map work, if data collection and mapping operations are to be performed for the entire area at once, it will take a long time, which seriously affects the work efficiency of container handling tasks. Summary of the invention

[0005] In view of this, the present invention provides a laser positioning method, computer equipment and storage medium for port vehicles, which can solve the problem that laser positioning requires the establishment and real-time maintenance and updating of a global point cloud map, which is time-consuming and leads to low container handling efficiency.

[0006] In order to solve the above technical problems, the present invention adopts the following technical solutions:

[0007] The present invention provides a laser positioning method for a port vehicle, which is applied to the port vehicle. The port vehicle includes a laser positioning sensor. The laser positioning method includes:

[0008] Determine the spatial coordinate system where the port vehicle is located, and determine the initial value of the position and posture of the port vehicle in the spatial coordinate system;

[0009] Collect the laser point cloud of the port vehicle in the corresponding environment in real time, and pre-process the laser point cloud of the port vehicle at the current moment and the laser point cloud at the previous moment, wherein the moment corresponding to the initial value is different from the current moment and the previous moment;

[0010] The preprocessed two-frame laser point cloud is matched between frames to obtain the posture conversion value, and the real-time posture initial value corresponding to the port vehicle at the current moment is obtained based on the posture conversion value and the initial value;

[0011] Based on the laser point clouds within a preset time length, a number of laser point clouds are selected as key frame point clouds, and a submap is generated based on the key frame point clouds, wherein the preset time length is from the spatial coordinate system where the port vehicle is located to the current moment, or a period of time from the spatial coordinate system where the port vehicle is located to the current moment;

[0012] Based on the laser point cloud, real-time initial pose value and sub-map at that moment, the laser positioning result of the port vehicle at the current moment is obtained.

[0013] In one embodiment of the present invention, determining a spatial coordinate system where a port vehicle is located, and determining an initial value of the position and posture of the port vehicle in the spatial coordinate system, includes:

[0014] The initial position and posture of the port vehicle in the spatial coordinate system is determined based on global satellite positioning technology.

[0015] In one embodiment of the present invention, a laser point cloud in a corresponding environment of a port vehicle is collected in real time, and the laser point cloud of the port vehicle at the current moment and the laser point cloud at the previous moment are preprocessed, including:

[0016] Based on the preset conditions, the laser point cloud at the current moment and the laser point cloud at the previous moment are range filtered, and a second filtering is performed through the voxel grid, and then the outliers of the laser point cloud are removed to obtain two frames of preprocessed laser point cloud, wherein the preset condition is that it is less than the predetermined distance corresponding to each coordinate axis of the port vehicle in the spatial coordinate system.

[0017] In one embodiment of the present invention, inter-frame matching is performed on two pre-processed laser point clouds to obtain a pose conversion value, including:

[0018] The pose transformation value includes the spatial translation and rotation transformation, which are used to determine the spatial translation distance and rotation transformation angle of the port vehicle.

[0019] In one embodiment of the present invention, based on the laser point clouds within a preset time length, a plurality of laser point clouds are selected as key frame point clouds, including:

[0020] Directly use the two frames of laser point cloud input at the initial moment as key frame point cloud; and,

[0021] Based on the preset time, preset translation distance and preset rotation angle, the laser point cloud that meets the requirements at other times is determined as the key frame point cloud.

[0022] In one embodiment of the present invention, based on the laser point cloud, real-time initial pose value and sub-map at that time, the laser positioning result of the port vehicle at the current time is obtained, including:

[0023] The laser point cloud at the current moment is frame-matched with the sub-map to obtain the position data of the port vehicle on the sub-map at the current moment. The position data is matrix-multiplied with the initial value of the real-time posture to obtain the laser positioning result of the port vehicle in the spatial coordinate system at the current moment.

[0024] In one embodiment of the present invention, the laser positioning method further comprises:

[0025] The posture data is obtained through the inertial measurement unit, and based on the laser positioning result and the posture data, the final laser positioning result of the port vehicle in the spatial coordinate system at the current moment is obtained.

[0026] In one embodiment of the present invention, based on the laser positioning result and the posture data, the final laser positioning result of the port vehicle in the spatial coordinate system at the current moment is obtained, including:

[0027] The posture data is integrated, and the result of the posture data integration is fused with the posture value in the laser positioning result to obtain the final laser positioning result.

[0028] The present invention also provides a computer device, comprising:

[0029] A memory, used for storing instructions for the port vehicle when it is working;

[0030] The processor is used to execute the above-mentioned laser positioning method for port vehicles based on the instructions.

[0031] The present invention also provides a computer-readable storage medium for storing a computer program, and when the computer program is executed by a processor, the laser positioning method for port vehicles is implemented.

[0032] The above technical solution of the present invention has at least the following beneficial effects:

[0033] The laser positioning method for port vehicles of the present invention realizes the laser positioning of port vehicles by determining the initial value of the real-time posture of the port vehicle and the position of the port vehicle on the sub-map. Compared with the traditional laser positioning method for port vehicles, which requires the establishment, real-time maintenance and update of a global laser point cloud map, the present invention only needs to maintain the sub-map generated by the laser point cloud in real time during the laser positioning process, which reduces the time for map building and data collection and reduces the difficulty of laser positioning operation. In addition, in the present invention, the laser positioning result is determined according to the initial value of the real-time posture of the port vehicle in the spatial coordinate system and the position of the port vehicle in the sub-map, and the positioning result of the port vehicle is calculated through two matchings, thereby ensuring the accuracy of laser matching positioning and facilitating improving the efficiency of laser positioning. BRIEF DESCRIPTION OF THE DRAWINGS

[0034] Figure 1 A scene diagram of a laser positioning method for a port vehicle according to an embodiment of the present invention;

[0035] Figure 2 A schematic structural diagram of a port vehicle according to an embodiment of the present invention;

[0036] Figure 3 A flow chart of a laser positioning method for a port vehicle according to an embodiment of the present invention;

[0037] Figure 4 A flowchart of determining an initial value of a position and posture of a port vehicle in a spatial coordinate system according to an embodiment of the present invention;

[0038] Figure 5 A flowchart of preprocessing the laser point cloud of a port vehicle at the current moment and the laser point cloud at the previous moment according to an embodiment of the present invention;

[0039] Figure 6 A flowchart of selecting a plurality of laser point clouds as key frame point clouds based on laser point clouds within a preset time period according to an embodiment of the present invention;

[0040] Figure 7 A schematic diagram of a computer device according to an embodiment of the present invention.

[0041] Reference numerals:

[0042] 100. Automated terminal;

[0043] 200, IGV;

[0044] 300. Satellite. DETAILED DESCRIPTION

[0045] In order to make the purpose, technical solution and advantages of the embodiment of the present invention clearer, the technical solution of the embodiment of the present invention will be clearly and completely described below in conjunction with the drawings of the embodiment of the present invention. Obviously, the described embodiment is a part of the embodiment of the present invention, not all of the embodiments. Based on the described embodiment of the present invention, all other embodiments obtained by ordinary technicians in this field belong to the scope of protection of the present invention.

[0046] The following first describes in detail the application scenario of the laser positioning method according to the embodiment of the present invention with reference to the accompanying drawings.

[0047] It should be noted that the port vehicle may be a movable vehicle such as a transporter or a navigation vehicle. The present invention takes an intelligence guide vehicle (IGV) working in an automated terminal as an example for explanation.

[0048] refer to Figure 1 , Figure 1 FIG. 1 shows a scene diagram of a laser positioning method for a port vehicle according to an embodiment of the present invention. Figure 1 As shown, there are many IGV200s on the automated terminal 100 that are constantly entering and exiting the quay crane for operation. IGV200 can communicate with the satellite 300 to obtain initial location information. The automated terminal 100 is relatively empty, and there are many external port vehicles, and the environmental characteristics are complex. Therefore, data collection and mapping take a long time, resulting in low positioning efficiency of IGV200 in the automated terminal 100.

[0049] refer to Figure 2 , Figure 2 FIG. 1 is a schematic diagram showing the structure of a port vehicle according to an embodiment of the present invention. Figure 2 As shown, the port vehicle includes a control system and a sensor. The control system may be a console for controlling the port vehicle. The sensor may be a laser positioning sensor for acquiring position data. The sensor may acquire position data according to the instruction of the control system, and send the position data to the control system, which processes and integrates the position data, and finally obtains the positioning result of the port vehicle.

[0050] The laser positioning method for port vehicles according to an embodiment of the present invention is described in detail below with reference to the accompanying drawings.

[0051] refer to Figure 3 , Figure 3 A flow chart of a laser positioning method for a port vehicle according to an embodiment of the present invention is shown.

[0052] like Figure 1 and Figure 3As shown, the laser positioning method for a port vehicle includes S110-S160, which is applied to a port vehicle, wherein the port vehicle includes a laser positioning sensor, wherein the laser positioning sensor is a sensor that uses laser technology for non-contact measurement, usually based on optical triangulation or laser echo analysis to measure the position and displacement of an object.

[0053] In S110, the space coordinate system where the port vehicle is located is determined, and the initial value of the position and posture of the port vehicle in the space coordinate system is determined.

[0054] For example, a spatial coordinate system is determined based on the automated terminal 100 where the IGV 200 is located, and the initial value of the position and posture of the IGV 200 in the spatial coordinate system is determined, and the initial value of the position and posture is a matrix. Among them, the coordinate axes of the spatial coordinate system are in three different directions and are perpendicular to each other. The origin of the spatial coordinate system can be any position on the automated terminal 100. For example, the initial position of the IGV 200 is used as the origin of the spatial coordinate system, and the three mutually perpendicular directions where the IGV 200 is located are used as the directions of the coordinate axes of the spatial coordinate system.

[0055] In S120, the laser point cloud in the corresponding environment of the port vehicle is collected in real time.

[0056] The laser point cloud refers to a collection of three-dimensional space points measured by the sensor of the IGV200 by emitting laser pulses and receiving light pulses reflected from the target object. For example, the laser point cloud data of the IGV200 operating on the automated terminal 100 is collected in real time by the laser positioning sensor.

[0057] In S130, the laser point cloud of the port vehicle at the current moment and the laser point cloud at the previous moment are preprocessed, wherein the moment corresponding to the initial value is different from the current moment and the previous moment.

[0058] For example, two frames of laser point cloud data of IGV200 at the current moment and the previous moment are preprocessed to remove noise points and abnormal points of the laser point cloud data, making the laser point cloud data more accurate and convenient for subsequent calculation and processing of the laser point cloud data. The moment corresponding to the initial value is the starting moment, which is different from the current moment and the previous moment. Among them, the laser point cloud data of IGV200 comes from the laser positioning sensor located on IGV200.

[0059] In S140, inter-frame matching is performed on the two pre-processed laser point clouds to obtain a posture conversion value, and based on the posture conversion value and the initial value, the real-time posture initial value corresponding to the port vehicle at the current moment is obtained.

[0060] For example, the posture conversion value is a matrix. Based on the initial value obtained in S110, the initial value in S110 is matrix-multiplied with the posture conversion value obtained in S140 to obtain the real-time posture initial value of IGV200 in the spatial coordinate system, which is also a matrix.

[0061] In S150, a preset time is determined, and based on the laser point clouds within the preset time, a plurality of laser point clouds are selected as key frame point clouds, and a submap is generated based on the key frame point clouds. The preset time is from the spatial coordinate system where the port vehicle is located to the current moment, or from the spatial coordinate system where the port vehicle is located to the current moment.

[0062] For example, from all the laser point clouds of the IGV 200 that have been acquired, several laser point clouds are selected as key frame point clouds through adaptive rules. The adaptive rule can be a preset range that is smaller than the current position of the IGV 200. Since the IGV 200 is constantly moving on the automated terminal 100, the key frame point cloud selected based on the adaptive rule is dynamically changing, which is conducive to accurately reflecting the environment of the automated terminal 100.

[0063] Generate the submap of IGV200 at the current moment based on the keyframe point cloud. Since the keyframe point cloud is dynamically changing, the submap generated based on the keyframe point cloud is also dynamically changing. By generating submaps, real-time maintenance and updating of the global map can be avoided, the workload of data collection is reduced, and the difficulty of generating maps is reduced.

[0064] In S160, based on the laser point cloud, real-time initial pose value and sub-map at that moment, the laser positioning result of the port vehicle at the current moment is obtained.

[0065] For example, the laser point cloud data of IGV200 at the current moment is first matched with the sub-map to obtain the current positioning position of IGV200 on the sub-map. Then, the result after frame matching is matrix multiplied with the initial value of real-time posture to obtain the laser positioning result of IGV200 at the current moment in the global spatial coordinate system. The process of frame matching will be described in detail in the following embodiments.

[0066] Compared with the laser positioning method of the prior art, it is necessary to establish and maintain a global laser point cloud map in real time, which is time-consuming and leads to low efficiency in container handling. The laser positioning method of the port vehicle of the present invention realizes the laser positioning of the port vehicle by determining the real-time initial position and posture of the port vehicle and the position of the port vehicle on the sub-map. In the laser positioning process, the present invention only needs to maintain the sub-map generated by the laser point cloud in real time, which reduces the time for map construction and data collection and reduces the difficulty of laser positioning operation. Furthermore, in the present invention, the laser positioning result is determined according to the real-time initial position and posture of the port vehicle in the spatial coordinate system and the position of the port vehicle in the sub-map, and the positioning result of the port vehicle is calculated through two matchings, which ensures the accuracy of laser matching positioning and is conducive to improving the efficiency of laser positioning.

[0067] The following is a detailed description of the embodiments of the present invention. Figure 3 Each step in is described in detail.

[0068] First, S110, determining the spatial coordinate system where the port vehicle is located, and determining the initial value of the position and posture of the port vehicle in the spatial coordinate system, will be described.

[0069] refer to Figure 4 , Figure 4 A flow chart of determining the initial value of the position and posture of a port vehicle in a spatial coordinate system according to an embodiment of the present invention is shown.

[0070] like Figure 4 As shown, in S110, determining the initial value of the position and posture of the port vehicle in the spatial coordinate system may include: determining the initial value of the position and posture of the port vehicle in the spatial coordinate system based on global satellite positioning technology. The global satellite positioning technology may be implemented by a global navigation satellite system (Global Navigation Satellite System, GNSS). Specifically, the following steps S111-S114 may be included.

[0071] Step S111: Acquire GNSS data of port vehicles through the global navigation satellite system.

[0072] Step S112: Perform status check on GNSS data.

[0073] Step S113: Determine whether the differential signal corresponding to the GNSS data is normal.

[0074] If the result of the judgment in step S113 is yes, step S114 is executed to use the GNSS data as the initial value of the port vehicle in the spatial coordinate system. In other words, obtaining the initial value of the position and posture of the spatial coordinate system where the IGV 200 is located through GNSS can ensure the accuracy and efficiency of the initial value of the IGV 200.

[0075] If the result of the judgment in step S113 is no, step S111 is executed to reacquire the GNSS data of the port vehicle through the global navigation satellite system to avoid using GNSS data with abnormal differential signals, thereby ensuring the validity of the GNSS data.

[0076] The following is an explanation of the preprocessing of the laser point cloud of the port vehicle at the current moment and the laser point cloud at the previous moment in S130.

[0077] refer to Figure 5 , Figure 5 A flow chart of preprocessing the laser point cloud of a port vehicle at the current moment and the laser point cloud at the previous moment according to one embodiment of the present invention is shown.

[0078] like Figure 5 As shown, in S130, the laser point cloud of the port vehicle at the current moment and the laser point cloud at the previous moment are preprocessed, which may include the following steps S131-S135.

[0079] Step S131: Determine that the preset condition is less than the predetermined distance corresponding to each coordinate axis of the port vehicle in the spatial coordinate system.

[0080] Step S132: performing range filtering on the two frames of laser point clouds based on preset conditions.

[0081] Step S133: Determine the voxel grid model.

[0082] Step S134: Perform a second filtering on the two frames of laser point clouds through the voxel grid.

[0083] Step S135: removing outliers from the laser point cloud to obtain two frames of preprocessed laser point clouds.

[0084] By preprocessing the two frames of laser point cloud data through the above steps, the points around the IGV200 body, namely, outliers and outliers, can be removed to make the laser point cloud data more accurate.

[0085] In one embodiment of the present invention, in S140, inter-frame matching is performed on the two pre-processed frames of laser point clouds to obtain a posture conversion value, including: the posture conversion value includes a spatial translation amount and a rotation transformation amount, which are used to determine the spatial translation distance and rotation transformation angle of the port vehicle.

[0086] For example, the two preprocessed laser point cloud frames are matched between frames using the scan-context method (i.e., an environment recognition and positioning method based on laser radar) to obtain a spatial translation relationship T and a rotation transformation relationship R.

[0087] Define the laser point cloud at the current moment as L t , the laser point cloud at the last moment is Lt-1 , then the translation transformation relationship T and rotation transformation relationship R of the current frame in the radar space coordinate system are:

[0088] T = arg min Sim (L t ,L t-1 )

[0089] R=2π / (T*N)

[0090] Among them, N is the number of ring divisions of the current frame point cloud. This value can be set according to the amount of data from the laser radar. Sim(L t ,L t-1 ) is the similarity calculation function in scan-context, defined as:

[0091]

[0092] in, YesL t The matrix composed of the data in the i-th column, YesL t-1 The matrix consisting of the i-th column numbers in .

[0093] That is to say, in the spatial coordinate system, the IGV200 car translates and rotates from point A (previous moment) to point B (current moment). The spatial translation is the difference between the coordinate values ​​of point A and point B. The rotation transformation is the difference between the attitude angles of point A and point B, such as the difference in heading angle, pitch angle and roll angle. It is helpful to record the change of the laser point cloud of IGV200.

[0094] In one embodiment of the present invention, reference Figure 6 , Figure 6 A flow chart is shown for selecting a number of laser point clouds as key frame point clouds based on laser point clouds within a preset time period.

[0095] like Figure 6 As shown, in S150, based on the laser point clouds within a preset time length, a number of laser point clouds are selected as key frame point clouds, which may include the following steps S151-S154.

[0096] Step S151: Determine whether the two frames of laser point cloud are input at the initial moment.

[0097] For example, all laser point clouds acquired by the sensor are marked in chronological order, and the mark can be a timestamp, that is, each frame of the laser point cloud has a timestamp representing the time when it was acquired. The control system of the port vehicle selects the two frames of laser point clouds input at the initial time according to the corresponding mark.

[0098] If the determination result in step S151 is yes, step S152 is executed.

[0099] Step S152: The two frames of laser point clouds input at the initial moment are used as key frame point clouds.

[0100] If the determination result in step S151 is no, step S153 is executed.

[0101] Step S153: Determine whether each frame of laser point cloud at other times is within the range of a preset time, a preset translation distance, and a preset rotation angle.

[0102] If the determination result in step S153 is yes, step S154 is executed.

[0103] Step S154: taking the laser point cloud at other times as the key frame point cloud.

[0104] For example, define τ as the time threshold, D TH is the translation distance threshold, ΔD is the translation distance between two adjacent frames of laser point cloud data, R TH is the rotation angle threshold, ΔR is the angle increment between two frames of data, and the key frame point cloud is defined as P key When the following formula is satisfied, the laser point cloud at the current moment is the key frame at that moment:

[0105]

[0106] On the one hand, this formula improves the calculation efficiency of the overlapping parts of two adjacent laser point clouds when the port vehicle, i.e., IGV200, is at low speed or stationary. On the other hand, it also ensures the feature matching of distant laser point clouds when the port vehicle is running at high speed. The combination of the two minimizes the drift of the global map, provides the positioning system with more proportional environmental features, and improves the accuracy of global consistency matching.

[0107] The key frame is updated by setting an adaptive distance threshold to update the key frame point cloud, eliminating old key frame point clouds that are far away and have no calculation value, and obtaining continuously updated key frame point cloud data.

[0108] The present invention defines the translation threshold adaptability of the key frame as:

[0109] sig t =asig t-1 +bD EU .

[0110] Among them, D EU is the three-dimensional Euclidean distance from the origin of the world coordinate system to the laser point cloud position at the current moment. a and b are two constants with a value range of a∈[0.90,1), b∈(0.01,0.10], sig t It is used to update the key frame threshold K at time tTH The smoothed signal, threshold K TH Defined as:

[0111]

[0112] By selecting and updating keyframe point clouds, the accuracy of the sub-map system can be ensured.

[0113] In one embodiment of the present invention, in S160, based on the laser point cloud, the real-time initial pose value and the sub-map at that moment, the laser positioning result of the port vehicle is obtained, which may include two steps.

[0114] The first step is to match the laser point cloud at the current moment with the sub-map to obtain the position data of the port vehicle on the sub-map at the current moment.

[0115] For example, the GICP algorithm can be selected as the frame image matching algorithm. Define the current time as t, the previous time as t-1, the global space coordinate system as g, the radar coordinate system as l, the sub-map system as sub, and the IGV200 pose obtained by GICP as The point cloud is P, so the GICP objective function is defined as:

[0116]

[0117] where ε is the residual in GICP, defined as:

[0118]

[0119] Among them, c t is the covariance matrix at the current moment, c t-1 is the covariance matrix of the previous moment, j is the index of the laser point sequence in the point cloud P, sum is the total number of laser points in the point cloud P, d j is the jth laser point in the point cloud P.

[0120] The above algorithm is used to obtain the current position data of IGV200 on the sub-map. The position data is a matrix, which facilitates more accurate positioning data of IGV200 in the spatial coordinate system.

[0121] In the second step, the position data is matrix multiplied with the initial value of the real-time posture to obtain the laser positioning result of the port vehicle in the spatial coordinate system at the current moment.

[0122] In another embodiment of the present invention, the laser positioning method may further include the following steps after step S160: acquiring posture data through an inertial measurement unit, and obtaining a final laser positioning result of the port vehicle in the spatial coordinate system at the current moment based on the laser positioning result and the posture data.

[0123] It should be noted that the inertial measurement unit is a device that measures the three-axis attitude angle (or angular rate) and acceleration of an object. The inertial measurement unit generally includes three single-axis accelerometers and three single-axis gyroscopes. The accelerometer detects the acceleration signal of the object in the independent three axes of the carrier coordinate system, while the gyroscope detects the angular velocity signal of the carrier relative to the navigation coordinate system, measures the angular velocity and acceleration of the object in three-dimensional space, and uses this to calculate the attitude of the object.

[0124] Furthermore, based on the laser positioning result and the posture data, the final laser positioning result of the port vehicle in the spatial coordinate system at the current moment is obtained, which can also include: integrating the posture data of the inertial measurement unit, and fusing the integrated posture data with the posture value in the laser positioning result to obtain the final laser positioning result.

[0125] The accuracy of laser positioning can be further improved by correcting the attitude value in the laser positioning result through the attitude data measured by the inertial measurement unit.

[0126] It should be noted that the specific calculation process of the posture data in the inertial measurement unit can refer to the calculation method in the prior art, and this application will not describe it in detail.

[0127] The present invention also provides a computer device, comprising a memory and a processor. The memory is used to store instructions (including software programs and data logs) when the port vehicle is working. The processor is used to execute the above-mentioned laser positioning method for the port vehicle based on the instructions.

[0128] refer to Figure 7 , Figure 7 A schematic diagram of a computer device according to an embodiment of the present invention is shown. Figure 7 As shown, the computer device of the embodiment of the present invention may also include a sensor device, an input / output interface, a bus, a memory and a processor. The sensor device is connected to the bus via the input / output interface. The memory and the processor are respectively connected to the bus.

[0129] Sensor equipment refers to external sensors installed on port vehicles, including but not limited to lidar, inertial measurement unit, global positioning system (GPS), etc.

[0130] The input and output interface is the interface device that directly transmits sensor data to the bus, including but not limited to network ports above 100M, Universal Serial Bus (USB) interfaces, etc.

[0131] The bus is used to transfer and share information between devices. The bus can be one of several bus types, including address bus, data bus, control bus, etc., serial bus, parallel bus, etc.

[0132] The present invention also provides a computer-readable storage medium for storing a computer program, and when the computer program is executed by a processor, the laser positioning method for port vehicles is implemented.

[0133] The working principle of the laser positioning method for port vehicles is explained below in conjunction with its steps.

[0134] Based on the spatial coordinate system determined by the automated terminal 100 where the IGV200 is located, the initial value of the posture of the IGV200 in the spatial coordinate system is determined. The laser point cloud data of the IGV200 when operating on the automated terminal 100 is collected in real time by the laser positioning sensor. It is judged whether each frame of the laser point cloud is the laser point cloud at the current moment or the laser point cloud at the previous moment. If so, the two frames of laser point cloud data of the IGV200 at the current moment and the previous moment are preprocessed to remove the noise points and abnormal points of the laser point cloud data. The two frames of laser point cloud after preprocessing are matched between frames to obtain the posture conversion value. The posture conversion value and the initial value are matrix multiplied to obtain the real-time posture initial value corresponding to the IGV200 at the current moment. The preset time length is determined, and it is judged whether each frame of the laser point cloud is within the preset time length and whether it is a key frame point cloud. If so, a submap of the IGV200 at the current moment is generated based on the key frame point cloud. Based on the laser point cloud, real-time initial pose value and sub-map at that moment, the laser positioning result of IGV200 at the current moment is obtained to realize the laser positioning of port vehicles.

[0135] In summary, the laser positioning method of the port vehicle of the present invention realizes the laser positioning of the port vehicle by determining the initial value of the real-time posture of the port vehicle and the position of the port vehicle on the sub-map, which reduces the time of map construction and data collection and reduces the difficulty of laser positioning operation. In addition, the laser positioning result is determined according to the initial value of the real-time posture of the port vehicle in the spatial coordinate system and the position of the port vehicle in the sub-map, and the positioning result of the port vehicle is calculated through two matchings, which ensures the accuracy of laser matching positioning and is conducive to improving the efficiency of laser positioning.

[0136] Unless otherwise defined, the technical terms or scientific terms used in the present invention shall have the usual meanings understood by persons with ordinary skills in the field to which the present invention belongs. The words "first", "second" and similar words used in the present invention do not indicate any order, quantity or importance, but are only used to distinguish different components. Similarly, words such as "one" or "one" do not indicate quantity restrictions, but indicate the existence of at least one. Words such as "connect" or "connected" are not limited to physical or mechanical connections, but may include electrical connections, whether direct or indirect. "Up", "down", "left", "right" and the like are only used to indicate relative positional relationships. When the absolute position of the object being described changes, the relative positional relationship also changes accordingly.

[0137] The above are preferred embodiments of the present invention. It should be pointed out that, for ordinary technicians in this technical field, several improvements and modifications can be made without departing from the principles of the present invention. These improvements and modifications should also be regarded as within the scope of protection of the present invention.

Claims

1. A laser positioning method for a port vehicle, applied to a port vehicle, wherein the port vehicle comprises a laser positioning sensor, characterized in that: The laser positioning method comprises: Determine the spatial coordinate system where the port vehicle is located, and determine the initial value of the position and posture of the port vehicle in the spatial coordinate system; Collecting the laser point cloud in the environment corresponding to the port vehicle in real time, and preprocessing the laser point cloud of the port vehicle at the current moment and the laser point cloud at the previous moment, wherein the moment corresponding to the initial value is different from the current moment and the previous moment; Performing inter-frame matching on the two preprocessed frames of the laser point cloud to obtain a posture conversion value, and obtaining a real-time posture initial value corresponding to the port vehicle at the current moment based on the posture conversion value and the initial value; Based on the laser point clouds within a preset time length, a number of the laser point clouds are selected as key frame point clouds, and a submap is generated based on the key frame point clouds, wherein the preset time length is a period of time from the spatial coordinate system where the port vehicle is located to the current moment, or from the spatial coordinate system where the port vehicle is located to the current moment; Based on the laser point cloud at that time, the real-time initial position and the sub-map, the laser positioning result of the port vehicle at the current time is obtained.

2. The laser positioning method for port vehicles according to claim 1, characterized in that: The step of determining the spatial coordinate system where the port vehicle is located and determining the initial value of the position and posture of the port vehicle in the spatial coordinate system includes: The initial value of the position and posture of the port vehicle in the spatial coordinate system is determined based on global satellite positioning technology.

3. The laser positioning method for port vehicles according to claim 1, characterized in that: The real-time acquisition of the laser point cloud in the corresponding environment of the port vehicle and the pre-processing of the laser point cloud of the port vehicle at the current moment and the laser point cloud of the previous moment include: Based on preset conditions, the laser point cloud at the current moment and the laser point cloud at the previous moment are range filtered, and a second filtering is performed through a voxel grid, and then the outliers of the laser point cloud are removed to obtain the two frames of preprocessed laser point cloud, wherein the preset condition is less than the predetermined distance corresponding to each coordinate axis of the port vehicle in the spatial coordinate system.

4. The laser positioning method for port vehicles according to claim 1, characterized in that: The performing inter-frame matching on the two pre-processed laser point clouds to obtain a posture conversion value includes: The posture conversion value includes a spatial translation amount and a rotation transformation amount, which are used to determine the spatial translation distance and rotation transformation angle of the port vehicle.

5. The laser positioning method for port vehicles according to claim 1, characterized in that: The step of selecting a plurality of laser point clouds as key frame point clouds based on the laser point clouds within a preset time period includes: Directly use the two frames of laser point clouds input at the initial moment as the key frame point clouds; and, Based on the preset time, the preset translation distance and the preset rotation angle, the laser point cloud that meets the requirements at other times is determined as the key frame point cloud.

6. The laser positioning method for port vehicles according to claim 5, characterized in that: The laser positioning result of the port vehicle at the current moment is obtained based on the laser point cloud at that moment, the real-time initial position and the sub-map, including: The laser point cloud at the current moment is frame matched with the sub-map to obtain the position data of the port vehicle on the sub-map at the current moment, and the position data is matrix multiplied with the real-time posture initial value to obtain the laser positioning result of the port vehicle in the spatial coordinate system at the current moment.

7. The laser positioning method for port vehicles according to claim 6, characterized in that: The laser positioning method also includes: The posture data is acquired through an inertial measurement unit, and based on the laser positioning result and the posture data, a final laser positioning result of the port vehicle in the space coordinate system at the current moment is obtained.

8. The laser positioning method for port vehicles according to claim 7, characterized in that: The method of obtaining the final laser positioning result of the port vehicle in the spatial coordinate system at the current moment based on the laser positioning result and the posture data includes: The posture data is integrated, and the result of the posture data integration is fused and calculated with the posture value in the laser positioning result to obtain the final laser positioning result.

9. A computer device, characterized in that: include: A memory, used for storing instructions for the port vehicle when it is working; A processor is used to execute the laser positioning method for a port vehicle according to any one of claims 1 to 8 based on the instructions.

10. A computer-readable storage medium for storing a computer program, characterized in that: When the computer program is executed by a processor, the laser positioning method for a port vehicle according to any one of claims 1 to 8 is implemented.

Citation Information

Patent Citations

  • A method and apparatus for identifying laser point cloud data for an unmanned vehicle

    CN109214248A

  • Laser radar data acquisition system and data processing method

    CN111077535A

  • Vehicle positioning method and device

    CN112462372A

  • Map updating method, computer equipment and storage device

    CN115127538A

  • Port unmanned container truck positioning method and system

    CN116659492A

Cited By

  • Single-trolley quay crane and guide vehicle automatic operation interaction system and control method thereof

    CN119541225A