Positioning method for fleet inside and outside port
By setting up positioning areas inside and outside the port and using the combination of inertial navigation data and signal ranging, the problem of high cost and insufficient accuracy of fleet positioning inside and outside the port is solved, the accurate and continuous positioning in the fleet is achieved, and the port is improved. Vehicles are driving flexibility and safety.
Patent Information
- Application Number
- CN202411505609.4
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Filing Date
- 2024-10-28
- Publication Date
- 2024-11-26
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
In the prior art, the positioning cost of the fleet inside and outside the port is relatively high, and the positioning accuracy and continuity are insufficient. Especially when the fleet enters the port, the interruption of the signal between vehicles leads to deviations in the positioning result, which reduces the accuracy and safety of vehicle monitoring.
By setting up positioning areas at road intersections and using a combination of inertial navigation data and signal ranging, the following vehicle positioning in the fleet is realized, reducing costs, and ensuring the continuity and precise positioning of the following vehicle through the setting of the positioning area. Improves vehicle driving flexibility and safety.
Accurate positioning of the following vehicles in the fleet, reduce costs, ensure the continuity and accuracy of positioning, improve the driving flexibility and safety of vehicles in the port, avoid the accumulation of inertial navigation positioning errors, and enhance the vehicle Management ability.
Smart Images

Figure CN119028116A_ABST
Abstract
Description
Technical Field
[0001] The present application relates to the technical field of port management, and in particular to a method for positioning fleets inside and outside a port. Background Art
[0002] With the popularization and application of information technology, in the actual production of ports, it is necessary to monitor the location and driving trajectory of external vehicles in the port in real time, which can generally be achieved by regional positioning or vehicle-mounted positioning.
[0003] Regional positioning uses cameras, RFID / UWB and other wireless positioning devices to calculate the real-time location of vehicles and count their driving trajectories when they pass by. This requires full coverage of the port operation area, and the deployment cost is high. In addition, during operation, due to the stacking of goods and containers in the port, as well as the movement of production equipment such as cranes and gantry cranes, monitoring is often blocked, resulting in certain blind spots.
[0004] Vehicle-mounted positioning is generally achieved through satellite positioning, mobile base station positioning, etc. The above methods are often affected by the strength of satellite signals and wireless communication signals, resulting in a large deviation between the positioning results and the actual position, thereby reducing the accuracy of vehicle monitoring.
[0005] Vehicles currently operating in the port can be equipped with auxiliary sensors such as lidar and cameras, which can be compared with high-precision maps of the port to assist in positioning the vehicles. However, this method has requirements for the installation locations of auxiliary sensors such as lidar and cameras, and they are scattered in multiple locations on the vehicle body. Obviously, it is not applicable to external vehicles entering the port.
[0006] The inertial navigation system, or inertial navigation system (INS), is an autonomous navigation system that does not rely on external information and does not radiate energy to the outside. Its basic working principle is based on Newton's laws of mechanics. By measuring the acceleration of the carrier in the inertial reference system, integrating it over time, and transforming it into the navigation coordinate system, it is possible to obtain information such as speed, yaw angle, and position in the navigation coordinate system. The inertial measurement unit, the core component of the inertial navigation system, integrates multiple sensors and has relatively simple requirements for the installation location. Therefore, there is currently a method of temporarily fixing a positioning device with an inertial navigation system on an external vehicle to achieve positioning, but the positioning device is relatively expensive. At the same time, most external vehicles enter the port to load and unload goods. Such external vehicles usually include multiple vehicles, which are transported in the form of a fleet. Temporarily fixing a positioning device on each vehicle further increases the cost. Summary of the invention
[0007] The purpose of this application is to solve the problem of high cost of positioning of fleets inside and outside ports in the prior art. Therefore, this application provides a positioning method for fleets inside and outside ports, which realizes positioning of following vehicles in the fleet by coordinating signal ranging and driving routes, reduces costs, and ensures the continuity of positioning of following vehicles through the setting of positioning areas, thereby improving the flexibility and safety of vehicle driving in ports.
[0008] This application provides a method for positioning a fleet inside and outside a port, including: Collecting a port map, and setting a positioning area at a road intersection, wherein a plurality of signal receivers are installed in the positioning area, and the plurality of signal receivers are used to determine any position within the positioning area, wherein the positioning area is an area with the center of the road intersection as the center of the circle; Collect the convoy length. When the convoy length is less than the minimum distance between the edge of the positioning area and the entrance of the corresponding road intersection, perform the following steps: A driving route is formulated according to the coordinates of the starting point, the coordinates of the target point, the port map and the preset rules, wherein the preset rule is that the driving route is composed of multiple line segments, and the sum of the lengths of any two adjacent line segments is greater than the length of the fleet; Obtaining the position of the pilot vehicle and the relative distances of adjacent vehicles in the convoy, wherein a driving route is provided for the pilot vehicle, and the pilot vehicle is equipped with a positioning device, the positioning device determines its position in the driving route through inertial navigation data, the positioning device includes a signal receiver, and the following vehicles in the convoy are equipped with a signal receiver and a signal transmitter, and the relative distances are obtained based on measurements of the signal transmitters and the signal receivers on the vehicles in the convoy; Determine the first position of the following vehicle in the convoy in sequence according to the relative distance, the position of the pilot vehicle and the driving route; Acquire a second position of a following vehicle in the motorcade, wherein the second position of the following vehicle in the motorcade is acquired based on measurements of a signal transmitter and a plurality of signal receivers in a positioning area; A position of a following vehicle in the convoy is determined based on the first position and the second position.
[0009] By adopting the above technical scheme, the leading vehicle in the convoy is positioned through the inertial navigation data of the positioning device, and the following vehicle in the convoy is positioned by coordinating signal ranging and driving routes, which reduces the cost compared to equipping all vehicles with positioning devices; and through the setting of the positioning area, the following vehicle can be positioned when the signal between the leading vehicle and the following vehicle is shielded at the corner, thereby ensuring the continuity of the positioning of the following vehicle; at the same time, by realizing accurate positioning of the following vehicle in the positioning area, it is convenient to realize the convoy's lane change and overtaking and other dispatching in the positioning area, thereby improving the driving flexibility and safety of vehicles in the port.
[0010] In some embodiments, when the pilot vehicle is located at the entrance of a road intersection in the positioning zone, a plurality of signal receivers corresponding to the positioning zone are activated; When the last following vehicle in the convoy is located at the exit of the road intersection of the corresponding positioning area, the multiple signal receivers of the corresponding positioning area are turned off.
[0011] The above technical solution can avoid the positioning area signal receiver being in a long-term working state, especially for a driving route passing through fewer positioning areas, thereby reducing energy consumption.
[0012] In some embodiments, determining a position of a following vehicle based on the first position and the second position includes: When only one of the first position or the second position is acquired, the acquired first position or the second position is used as the position of the following vehicle; When the first position and the second position are acquired simultaneously, the acquired second position is used as the position of the following vehicle; and The position of the pilot vehicle is corrected based on the second position.
[0013] By adopting the above technical solution, continuous positioning of the following vehicle is achieved, and the position of the pilot vehicle is corrected through the second position of the following vehicle with higher accuracy, thus avoiding the continuous amplification of the accumulated errors of the inertial navigation positioning during continuous operation and improving the positioning accuracy of the pilot vehicle.
[0014] In some embodiments, an alert is issued to the fleet in response to the alert information, wherein: The alarm information is generated based on the triggering of the electronic fence or grating fence, which is installed on both sides of the road inside the port outside the positioning area, and When the electronic fence or the grating fence is triggered, the triggered convoy is determined based on the triggered position, the position of the pilot vehicle and the corresponding convoy length.
[0015] In some embodiments, a driving priority is determined for a fleet entering a port; Determine the passing order of the positioning area: when a convoy enters the entrance of the road intersection of the positioning area, detect whether there is a convoy with a higher driving priority than the convoy within a preset distance from the center of the positioning area; If yes, the initial order of passing through the positioning area is determined in turn according to the driving priority and the estimated arrival time, and whether the corresponding fleet has the possibility of passing through the positioning area is determined in turn according to the initial order; If all possibilities are met, the initial sequence will be sent to the corresponding fleet; If any possibility is not met, the order of the first convoy is adjusted to be before the order of the second convoy, and the passing possibility is recalculated until all possibilities are met, and the departure order is generated and sent to the corresponding convoys, where the second convoy refers to the convoy that cannot pass through the positioning area, and the first convoy refers to the convoy closest to the second convoy in front; After all convoys in each round of initial sequence or departure sequence have passed through the positioning area, the order of passing through the positioning area is repeatedly determined according to the time sequence of the entrances to the road intersections entering the positioning area.
[0016] The above technical solution ensures that the fleet with higher driving priority can drive preferentially, thereby improving the vehicle management capability in the port. In some embodiments, the fleet has the possibility of passing through the positioning area, including: The convoy passes through the positioning area according to its corresponding driving route; or, Based on the positions of all convoys in the positioning area, the convoy is allowed to change lanes, overtake and pass through the positioning area.
[0017] In some embodiments, the preset distance d is: d=max(s / v*v max , R), Where s is the length of the path that the team passes through the positioning area, v is the average speed of the team in the positioning area, and v max is the maximum vehicle speed allowed in the port, and R is the radius of the corresponding positioning area.
[0018] In some embodiments, the convoy length L is: , Among them, M is the total length of each vehicle in the convoy, n is the total distance between adjacent vehicles in the convoy, a is the weight constant, and k is the vehicle density on the roads in the port.
[0019] By adopting the above technical solution, the length of the fleet is controlled according to the different vehicle densities on the roads in the port, taking into account the driving efficiency and safety of vehicles in the port.
[0020] In some embodiments, roads within the port map are numbered according to road intersections; Determine the initial point and obtain the initial point position , and the road number in the map ; The positioning device is installed on the pilot vehicle at the initial point, and the positioning device is started and initialized; Periodically obtain the inertial navigation data of the positioning device and use the positioning results of the previous cycle , determine the current rough positioning result of the pilot vehicle , t is the periodic sequence; According to the road number in the map where the pilot vehicle is located recorded in the previous cycle And the rough positioning results ,judge and Whether the distance between the end points is less than a first threshold; If so, for each road in the possible road set Estimate the likelihood , by comparison The value determines the current road of the pilot vehicle; in, , The coarse positioning result of the pilot vehicle The distance difference with the corresponding road, for The difference in heading angle from the corresponding road, for The difference between the orientation angle change rate of the corresponding road, , , is the corresponding preset weight constant.
[0021] In some embodiments, while the pilot vehicle is still on the current road , then construct the positioning correction value ,in For the pilot vehicle relative to The vertical distance is greater than or equal to The longitudinal distance is less than Total length, For the pilot vehicle relative to The horizontal distance is preferably 0, for exist The orientation angle at When the lead vehicle leaves the current road , and enter The subsequent road One of them, then construct the positioning correction value ,in , , is the position and orientation angle of the starting point of the subsequent road; according to , Get the position of the pilot vehicle ,in is the Kalman gain, is the state transition matrix.
[0022] The adoption of the above technical solution avoids the continuous amplification of accumulated errors in inertial navigation positioning during continuous operation, thereby improving the positioning accuracy of the pilot vehicle.
[0023] Other features and corresponding beneficial effects of the present application are described in the latter part of the specification, and it should be understood that at least some of the beneficial effects become obvious from the records in the specification of the present application. BRIEF DESCRIPTION OF THE DRAWINGS
[0024] Figure 1 This is a schematic diagram of the process of an embodiment of the present application; Figure 2 This is a schematic diagram of the driving state of a fleet in a positioning area according to an embodiment of the present application; Figure 3 This is a schematic diagram of the state of a pilot vehicle located at the entrance of a road intersection in a positioning area in an embodiment of the present application. DETAILED DESCRIPTION
[0025] The following specific embodiments illustrate the implementation of the present application, and those skilled in the art can easily understand other advantages and effects of the present application from the contents disclosed in this specification. Although the description of the present application will be introduced in conjunction with the preferred embodiment, this does not mean that the features of this application are limited to the implementation. On the contrary, the purpose of introducing the application in conjunction with the implementation is to cover other options or modifications that may be extended based on the claims of the present application. In order to provide a deep understanding of the present application, the following description will include many specific details. The present application can also be implemented without using these details. In addition, in order to avoid confusion or blurring the focus of the present application, some specific details will be omitted in the description. It should be noted that the embodiments in the present application and the features in the embodiments can be combined with each other without conflict.
[0026] It should be noted that in this specification, similar reference numerals and letters denote similar items in the following drawings, and therefore, once an item is defined in one drawing, it does not need to be further defined and explained in the subsequent drawings.
[0027] The technical solution of the present application will be described clearly and completely below in conjunction with the accompanying drawings. Obviously, the described embodiments are part of the embodiments of the present application, rather than all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present application.
[0028] In the description of the present application, it should be noted that the terms "center", "up", "down", "left", "right", "vertical", "horizontal", "inside", "outside", etc. indicate positions or positional relationships based on the positions or positional relationships shown in the accompanying drawings, which are only for the convenience of describing the present application and simplifying the description, and do not indicate or imply that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as a limitation on the present application. In addition, the terms "first", "second", and "third" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance or implicitly indicating the number of technical features indicated. Therefore, features defined as "first", "second", etc. may explicitly or implicitly include one or more of the features. In the description created by the present application, unless otherwise specified, "multiple" means two or more.
[0029] In the description of this application, it should be noted that, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection, or it can be indirectly connected through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in this application can be understood according to specific circumstances.
[0030] In order to make the objectives, technical solutions and advantages of the present application clearer, the implementation methods of the present application will be further described in detail below in conjunction with the accompanying drawings.
[0031] See also Figure 1 , Figure 1 It is a schematic diagram of the process of an embodiment of the present application.
[0032] The embodiment of the present application provides a method for positioning a fleet inside or outside a port, including: A port map is collected, and a positioning area is set up at a road intersection. The positioning area is equipped with multiple signal receivers, and the multiple signal receivers are used to determine any position within the positioning area, wherein the positioning area is an area with the center of the road intersection as the center of the circle.
[0033] The length of the convoy is collected, and when the convoy length is less than the minimum distance between the edge of the positioning area and the entrance of the corresponding road intersection, that is, when the pilot vehicle is located at the entrance of the road intersection of the positioning area, the positioning area can realize the full positioning of the convoy vehicles.
[0034] At this point, perform the following steps: The driving route is formulated according to the coordinates of the starting point, the target point, the port map and the preset rules. The preset rule is that the driving route consists of multiple line segments, that is, the port is a straight road, to avoid the interruption of vehicle-to-vehicle communication signals due to the stacking of containers on the side of the road, and the sum of the lengths of any two adjacent line segments is greater than the length of the fleet, thereby reducing the situation where the fleet occupies multiple road intersections at the same time during driving, that is, multiple positioning areas, which leads to difficulty in scheduling within the positioning areas.
[0035] Get the position of the lead vehicle and the relative distances of each adjacent vehicle in the convoy.
[0036] Wherein, a driving route is provided for the pilot vehicle, and the pilot vehicle is equipped with a positioning device, which determines its position in the driving route through inertial navigation data, and the positioning device includes a signal receiver, and the following vehicles in the convoy are equipped with a signal receiver and a signal transmitter, and the relative distance is measured and obtained based on the signal transmitter and signal receiver on the vehicles in the convoy.
[0037] According to the relative distance, the position of the pilot vehicle and the driving route, the first position of the following vehicle in the convoy is determined in sequence.
[0038] Specifically, the relative distance is obtained based on the signal sent by the rear vehicle to the front vehicle. The relative distance can be a single distance, and the rear vehicle obtains the first position through the single distance in conjunction with the driving route. At this time, the first position is a rough position, which meets the preliminary positioning requirements of each vehicle in the fleet; the relative distance can also be multiple distances, such as 2 distances or 3 distances, etc. The rear vehicle obtains the first position through multiple distances. At this time, the first position is an absolute position. Preferably, a single distance is used to obtain the first position in conjunction with the driving route, thereby reducing the difficulty of data processing, the number of signal transmitters or signal receivers and installation requirements, and thus controlling costs.
[0039] The second position of the following vehicle in the convoy is obtained, wherein the second position of the following vehicle in the convoy is measured and obtained based on a signal transmitter and multiple signal receivers in the positioning area, that is, the second position is an absolute position, thereby facilitating accurate command and dispatch of the vehicle in the positioning area.
[0040] A position of a following vehicle in the convoy is determined based on the first position and the second position.
[0041] In this way, the pilot vehicle in the convoy is positioned through the inertial navigation data of the positioning device, and the following vehicles in the convoy are positioned by coordinating signal ranging and driving routes. Compared with equipping all vehicles with positioning devices, this reduces costs. In addition, by setting up the positioning area, the following vehicle can be positioned when the signal between the pilot vehicle and the following vehicle is shielded at the corner, ensuring the continuity of the following vehicle positioning. At the same time, by accurately positioning the following vehicle in the positioning area, it is convenient to realize the convoy's lane change and overtaking and other scheduling in the positioning area, thereby improving the flexibility and safety of vehicle driving in the port.
[0042] See also Figure 2 , Figure 2 This is a schematic diagram of the driving status of a fleet in a positioning area according to an embodiment of the present application.
[0043] In most cases, there are container stacks, large machinery or buildings around the road intersections in the port. In addition, when the convoy turns, the distance between vehicles may change greatly due to the type of vehicle and driving skills. Therefore, when the vehicle turns, it is easy to cause signal interruption between the front and rear vehicles, resulting in the following vehicle being unable to achieve positioning through the pilot vehicle. At this time, positioning through the positioning area can ensure positioning continuity.
[0044] It should also be noted that the fleet can be split into multiple fleets so that the fleet length meets the requirements.
[0045] See also Figure 3 , Figure 3 This is a schematic diagram of the state of a pilot vehicle located at the entrance of a road intersection in a positioning area in an embodiment of the present application.
[0046] In one embodiment, when the pilot vehicle is located at the entrance of the road intersection of the positioning area, multiple signal receivers in the corresponding positioning area are started; when the last following vehicle in the convoy is located at the exit of the road intersection of the corresponding positioning area, multiple signal receivers in the corresponding positioning area are turned off, thereby avoiding the positioning area signal receivers from being in a long-term working state, especially for a driving route passing through fewer positioning areas, thereby reducing energy consumption.
[0047] It should be noted that the road intersection may be a cross intersection, a three-way intersection, or a junction of two roads connected at an angle.
[0048] In one embodiment, determining the position of the following vehicle according to the first position and the second position includes: When only either the first position or the second position is acquired, the acquired first position or the second position is adopted as the position of the following vehicle.
[0049] When the first position and the second position are obtained at the same time, the obtained second position is used as the position of the following vehicle, thereby achieving continuous positioning of the following vehicle; and The position of the pilot vehicle is corrected according to the second position, that is, the position of the pilot vehicle is corrected by following the second position of the vehicle with higher accuracy, thereby avoiding the continuous amplification of the accumulated errors of the inertial navigation positioning during continuous operation and improving the positioning accuracy of the pilot vehicle.
[0050] In one embodiment, an alert is issued to the fleet in response to the alert information.
[0051] Among them, the alarm information is generated based on the triggering of the electronic fence or grating fence. The electronic fence or grating fence is installed on both sides of the road in the port outside the positioning area. When the electronic fence or grating fence is triggered, the triggered convoy is determined according to the triggered position, the position of the pilot vehicle and the corresponding convoy length.
[0052] Management vehicles within the port can obtain whether the fleet is driving correctly on the designated route based on the alarm information and manage it.
[0053] In one embodiment, when a following vehicle in a convoy leaves the convoy and is located on its non-designated driving route, the vehicle can be located by broadcasting and receiving a signal corresponding to the separated vehicle to all vehicles in the port.
[0054] In one embodiment, driving priorities are determined for fleets entering the port to facilitate efficient and flexible management of vehicles in the port.
[0055] Determine the order of passing through the positioning area: When a convoy enters the entrance of the road intersection of the positioning area, detect whether there is a convoy with a higher driving priority than the convoy within a preset distance from the center of the positioning area.
[0056] If not, the positioning area will be passed in sequence according to the arrival time.
[0057] If so, the initial order of passing through the positioning area is determined according to the driving priority and the estimated arrival time, that is, the priority is sorted first and the same level time is sorted, and the corresponding fleet is judged in turn according to the initial order whether it is possible to pass through the positioning area.
[0058] If all possibilities are met, the initial sequence will be sent to the corresponding fleet.
[0059] If any possibility does not exist, the order of the first fleet will be adjusted before the order of the second fleet, and the passing possibilities will be recalculated until all possibilities exist, and the departure order will be generated and sent to the corresponding fleets, where the second fleet refers to the fleet that cannot pass through the positioning area, and the first fleet refers to the fleet in front that is closest to the second fleet.
[0060] When all convoys in each round of initial sequence or departure sequence have passed through the positioning area, the order of passing through the positioning area is repeatedly determined according to the time sequence of the entrances to the road intersections entering the positioning area, thereby ensuring that convoys with higher driving priorities can be given priority in driving, thereby improving the vehicle management capabilities within the port.
[0061] In one embodiment, the possibility that a convoy passes through a positioning zone includes: The convoy passes through the positioning area according to its corresponding driving route; or, Based on the positions of all convoys in the positioning area, the convoy is allowed to change lanes, overtake and pass through the positioning area.
[0062] In one embodiment, the preset distance d is: d=max(s / v*v max , R), Where s is the length of the path that the team passes through the positioning area, v is the average speed of the team in the positioning area, and v max is the maximum vehicle speed allowed in the port, and R is the radius of the corresponding positioning area.
[0063] In one embodiment, the convoy length L is: , Among them, M is the total length of each vehicle in the convoy, n is the total distance between adjacent vehicles in the convoy, a is the weight constant, and k is the vehicle density on the roads in the port.
[0064] This method controls the length of the fleet according to the different vehicle densities on the roads within the port, taking into account the driving efficiency and safety of vehicles within the port.
[0065] In one embodiment, roads within the port map are numbered according to road intersections; Determine the initial point and obtain the initial point position , and the road number in the map The initial point is usually set at the port entrance.
[0066] At the initial point, the positioning device is installed on the pilot vehicle, and the positioning device is started and initialized. Initialization includes: obtaining the inertial navigation data of the positioning device , initialize the installation position of the positioning device relative to the pilot vehicle , ,in, To guide the vehicle's posture, is the roll angle, is the pitch angle, is the yaw angle.
[0067] Periodically obtain the inertial navigation data of the positioning device and use the positioning results of the previous cycle , determine the current rough positioning result of the pilot vehicle , t is the periodic sequence; According to the road number in the map where the pilot vehicle is located recorded in the previous cycle And the rough positioning results ,judge and Is the distance between the end points less than the first threshold, that is, whether the vehicle is likely to be close to the current road The connection of the subsequent road is expected. The first threshold may be 5m.
[0068] If so, for each road in the possible road set Estimate the likelihood , by comparison The value determines the current road of the pilot vehicle, that is, if the vehicle is close to the current road end point, then by comparison, it is determined that the vehicle is still at Or has already driven to the next road .
[0069] It can be understood that the possible road set includes the road where the vehicle was located in the previous cycle, and other roads within a preset distance from the road where the vehicle was located in the previous cycle, and the preset distance may be 20m.
[0070] The current road of the pilot vehicle is determined by comparing the values, for example, the road with the smallest C value is taken as the current road.
[0071] when The value exceeds the second threshold, indicating that the vehicle has deviated from the road, and a warning should be sent to the vehicle.
[0072] The second threshold may be 10 m.
[0073] in, , The coarse positioning result of the pilot vehicle The distance difference with the corresponding road, for The difference in heading angle from the corresponding road, for The difference between the orientation angle change rate of the corresponding road, , , is the corresponding preset weight constant.
[0074] In one embodiment, when the pilot vehicle is still on the current road , then construct the positioning correction value ,in For the pilot vehicle relative to The vertical distance is greater than or equal to The longitudinal distance is less than Total length, For the pilot vehicle relative to The horizontal distance is preferably 0, for exist The orientation angle of the .
[0075] When the lead vehicle leaves the current road , and enter The subsequent road One of them, then construct the positioning correction value ,in , , It is the position and orientation angle of the starting point of the subsequent road.
[0076] according to , Get the position of the pilot vehicle ,in is the Kalman gain, is the state transition matrix.
[0077] This method avoids the continuous amplification of the accumulated errors of the inertial navigation positioning during continuous operation, thereby improving the positioning accuracy of the pilot vehicle. Moreover, compared with correcting the position of the pilot vehicle through the second position, the position of the pilot vehicle can be continuously corrected, further improving the position accuracy of the pilot vehicle.
[0078] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present application, rather than to limit it. Although the present application has been described in detail with reference to the aforementioned embodiments, those skilled in the art should understand that they can still modify the technical solutions described in the aforementioned embodiments, or replace some or all of the technical features therein with equivalents. However, these modifications or replacements do not cause the essence of the corresponding technical solutions to deviate from the scope of the technical solutions of the embodiments of the present application.
Claims
1. A method for positioning a fleet inside or outside a port, characterized in that: include: Collecting a port map, and setting a positioning area at a road intersection, wherein a plurality of signal receivers are installed in the positioning area, and the plurality of signal receivers are used to determine any position within the positioning area, wherein the positioning area is an area with the center of the road intersection as the center of the circle; Collect the convoy length. When the convoy length is less than the minimum distance between the edge of the positioning area and the entrance of the corresponding road intersection, perform the following steps: A driving route is formulated according to the coordinates of the starting point, the coordinates of the target point, the port map and the preset rules, wherein the preset rule is that the driving route is composed of multiple line segments, and the sum of the lengths of any two adjacent line segments is greater than the length of the fleet; Obtaining the position of the pilot vehicle and the relative distances of adjacent vehicles in the convoy, wherein a driving route is provided for the pilot vehicle, and the pilot vehicle is equipped with a positioning device, the positioning device determines its position in the driving route through inertial navigation data, the positioning device includes a signal receiver, and the following vehicles in the convoy are equipped with a signal receiver and a signal transmitter, and the relative distances are obtained based on measurements of the signal transmitters and the signal receivers on the vehicles in the convoy; Determine the first position of the following vehicle in the convoy in sequence according to the relative distance, the position of the pilot vehicle and the driving route; Acquire a second position of a following vehicle in the motorcade, wherein the second position of the following vehicle in the motorcade is acquired based on measurements of a signal transmitter and a plurality of signal receivers in a positioning area; A position of a following vehicle in the convoy is determined based on the first position and the second position.
2. The method for positioning a fleet inside or outside a port according to claim 1, characterized in that: When the pilot vehicle is located at the entrance of the road intersection of the positioning area, multiple signal receivers corresponding to the positioning area are activated; When the last following vehicle in the convoy is located at the exit of the road intersection of the corresponding positioning area, the multiple signal receivers of the corresponding positioning area are turned off.
3. The method for positioning a fleet inside or outside a port according to claim 1, characterized in that: Determining a position of a following vehicle according to the first position and the second position includes: When only one of the first position or the second position is acquired, the acquired first position or the second position is used as the position of the following vehicle; When the first position and the second position are acquired simultaneously, the acquired second position is adopted as the position of the following vehicle; and The position of the pilot vehicle is corrected based on the second position.
4. The method for positioning a fleet inside or outside a port according to claim 1, characterized in that: In response to the alarm information, an alarm is issued to the fleet, wherein: The alarm information is generated based on the triggering of the electronic fence or grating fence, which is installed on both sides of the road inside the port outside the positioning area, and When the electronic fence or the grating fence is triggered, the triggered convoy is determined based on the triggered position, the position of the pilot vehicle and the corresponding convoy length.
5. The method for positioning a fleet inside or outside a port according to claim 1, characterized in that: Determine driving priorities for convoys entering the port; Determine the passing order of the positioning area: when a convoy enters the entrance of the road intersection of the positioning area, detect whether there is a convoy with a higher driving priority than the convoy within a preset distance from the center of the positioning area; If yes, the initial order of passing through the positioning area is determined in turn according to the driving priority and the estimated arrival time, and whether the corresponding fleet has the possibility of passing through the positioning area is determined in turn according to the initial order; If all possibilities are met, the initial sequence will be sent to the corresponding fleet; If any possibility is not met, the order of the first convoy is adjusted to be before the order of the second convoy, and the passing possibility is recalculated until all possibilities are met, and the departure order is generated and sent to the corresponding convoys, where the second convoy refers to the convoy that cannot pass through the positioning area, and the first convoy refers to the convoy closest to the second convoy in front; After all convoys in each round of initial sequence or departure sequence have passed through the positioning area, the order of passing through the positioning area is repeatedly determined according to the time sequence of the entrances to the road intersections entering the positioning area.
6. The method for positioning a fleet inside or outside a port according to claim 5, characterized in that: The possibilities for the convoy to pass through the positioning area include: The convoy passes through the positioning area according to its corresponding driving route; or, Based on the positions of all convoys in the positioning area, the convoy is allowed to change lanes, overtake and pass through the positioning area.
7. The method for positioning a fleet inside or outside a port according to claim 5, characterized in that: The preset distance d is: d=max(s / v*v max ,R), Where s is the length of the path that the team passes through the positioning area, v is the average speed of the team in the positioning area, and v max is the maximum vehicle speed allowed in the port, and R is the radius of the corresponding positioning area.
8. The method for positioning a fleet inside or outside a port according to claim 1, characterized in that: The length of the convoy L is: , Among them, M is the total length of each vehicle in the convoy, n is the total distance between adjacent vehicles in the convoy, a is the weight constant, and k is the vehicle density on the roads in the port.
9. The method for positioning a fleet inside or outside a port according to claim 1, characterized in that: Number the roads in the port map according to their intersections; Determine the initial point and obtain the initial point position , and the road number in the map ; The positioning device is installed on the pilot vehicle at the initial point, and the positioning device is started and initialized; Periodically obtain the inertial navigation data of the positioning device and use the positioning results of the previous cycle , determine the current rough positioning result of the pilot vehicle , t is the periodic sequence; According to the road number in the map where the pilot vehicle is located recorded in the previous cycle And the rough positioning results ,judge and Whether the distance between the end points is less than a first threshold; If so, for each road in the possible road set Estimate the likelihood , by comparison The value determines the current road of the pilot vehicle; in, , The coarse positioning result of the pilot vehicle The distance difference with the corresponding road, for The difference in heading angle from the corresponding road, for The difference between the rate of change of the heading angle of the corresponding road, , , is the corresponding preset weight constant.
10. The method for positioning a fleet inside or outside a port according to claim 9, characterized in that: When the pilot vehicle is still on the current road , then construct the positioning correction value ,in For the pilot vehicle relative to The vertical distance is greater than or equal to The longitudinal distance is less than Total length, For the pilot vehicle relative to The horizontal distance is preferably 0, for exist The orientation angle at When the lead vehicle leaves the current road , and enter The subsequent road One of them, then construct the positioning correction value ,in , , is the position and orientation angle of the starting point of the subsequent road; according to , Get the position of the pilot vehicle ,in is the Kalman gain, is the state transition matrix.
Citation Information
Patent Citations
OBU (on board unit) positioning method, equipment and system based on time measurement
CN102353935A
Completely independent relative inertial navigation method
CN102628691A
Multi-information fusion positioning method and apparatus
CN103744096A
New relative positioning method for ship formation
CN105467418A
Intelligent vehicle matrix following aided driving method
CN105698783A
Cited By
Motorcade cooperative positioning method, vehicle, electronic equipment and storage medium
CN120496308A
