Vehicle Navigation Positioning Method and Apparatus, and Base Station, System and Readable Storage Medium
20230213946 ยท 2023-07-06
Assignee
Inventors
Cpc classification
G01C21/005
PHYSICS
International classification
Abstract
Disclosed are a vehicle navigation positioning method, apparatus, base station and system and a readable storage medium. The vehicle navigation positioning method includes: receiving a navigation positioning service request and generating driving planned route information (S301); collecting navigation positioning parameters, and calculating according to the navigation positioning parameters to acquire a positioning error value accumulated during unmanned vehicle driving (S302); inquiring about a closest navigation correcting base station according to the driving planned route information when the positioning error value accumulated during unmanned vehicle driving reaches a positioning error threshold (S303); and establishing communication connection with the navigation correcting base station, acquiring navigation correcting parameters through the navigation correcting base station and modifying the navigation positioning parameters according to the navigation correcting parameters (S304). By calculating the accumulated error value in the navigation positioning process and modifying the navigation positioning parameters through the navigation correcting base station, an unmanned vehicle can constantly correct errors in the driving process, and when entering a working area, has a positioning precision level required by operation so as to be applicable to application scenarios with accurate positioning requirements.
Claims
1-10. (canceled)
11. An error-correcting navigation system for autonomous robots, comprising: an autonomous robot, comprising: a first camera module housed in a first rotating holder; a first optical beacon; a first transceiver; a plurality of sensors capable of acquiring motion data; and a first processor configured to: estimate the location of the autonomous robot in a virtual map based on the motion data; and orient the first rotating holder such that the camera module is pointed at a base station by tracking a second optical beacon on top of the base station using the camera module; and the base station, comprising: the second optical beacon; a second camera module housed in a second rotating holder; a measurement module housed in the second rotating holder capable of accurately measuring the distance to a target; a second transceiver; and a second processor configured to: receive the estimated location of the autonomous robot using the second transceiver; orient the second rotating holder such that the second camera module and the measurement module are pointed at the first optical beacon by tracking the first optical beacon using the second camera module; measure a current distance between the base station and the autonomous robot using the measurement module and the first optical beacon; calculate an updated location of the autonomous robot in the virtual map using the current distance and a rotation angle of the second rotating holder; and transmit the updated location of the autonomous robot to the autonomous robot using the second transceiver; wherein the first processor is further configured to: receive the updated location from the base station using the first transceiver; and update the estimated location to be the updated location using a rotation angle of the first rotating holder.
12. The error-correcting navigation system for autonomous robots of claim 11, wherein the plurality of sensors comprises an inertial positioning system.
13. The error-correcting navigation system for autonomous robots of claim 11, wherein the first processor is further configured to request the updated location when a positioning error threshold is exceeded.
14. The error-correcting navigation system for autonomous robots of claim 11, wherein the first processor is further configured to: navigate the autonomous robot towards a target location; request the updated location from the base station when the autonomous robot is at the target location according to the estimated location on the virtual map; and adjust the position of the autonomous robot to the target location using the updated location if the difference between the estimated location and the updated location is above a position error threshold.
15. The error-correcting navigation system for autonomous robots of claim 14, wherein the first processor is further configured to request a second updated location from the base station after adjustment in order to confirm that the autonomous robot is at the target location.
16. The error-correcting navigation system for autonomous robots of claim 11, further comprising a second base station, where the autonomous robot is configured to request an updated location from the second base station when the second base station is closer than the base station.
17. The error-correcting navigation system for autonomous robots of claim 11, wherein the first processor is further configured to update the plurality of sensors to reduce measurement error using the estimated location and the updated location.
18. The error-correcting navigation system for autonomous robots of claim 11, wherein the autonomous robot is a wheeled robot.
19. The error-correcting navigation system for autonomous robots of claim 11, wherein the second processor is further configured to: locate a third optical beacon and a fourth optical beacon using the second camera module and the second rotating holder, where the third and fourth optical beacons have known coordinates; measure a distance from the base station to the third optical beacon and a distance from the base station to the fourth optical beacon using the measurement module; and calculate the position of the base station by applying a triangulation method.
20. An error-correcting method for precision navigation of autonomous robots, comprising: estimating, at a first processor housed in an autonomous robot, the location of the autonomous robot in a virtual map based on motion data captured by a plurality of sensors of the autonomous robot; orienting a camera module of the autonomous robot such that the camera module is pointed at a base station by tracking a second optical beacon on top of a base station using the camera module, where the camera module is oriented using a first rotating holder mounted on the autonomous robot; transmitting the estimated location to a base station using a first transceiver of the autonomous robot; receiving the estimated location using a second transceiver of the base station; orienting a second rotating holder of the base station such that a second camera module and a measurement module housed in the second rotating holder are pointed at a first optical beacon mounted on the autonomous vehicle by tracking the first optical beacon using the second camera module; measuring a current distance between the base station and the autonomous robot using the measurement module and the first optical beacon; calculating, using a second processor of the base station, an updated location of the autonomous robot in the virtual map using the current distance and a rotation angle of the second rotating holder; and transmitting the updated location of the autonomous robot to the autonomous robot using the second transceiver; receiving the updated location from the base station using the first transceiver; and updating, using the first processor, the estimated location to be the updated location using a rotation angle of the first rotating holder.
21. The error-correcting method for precision navigation of autonomous robots of claim 20, wherein the plurality of sensors comprises an inertial positioning system.
22. The error-correcting method for precision navigation of autonomous robots of claim 20 further comprising, requesting, using the first processor and the first transceiver, the updated location from the base station when a positioning error threshold is exceeded.
23. The error-correcting method for precision navigation of autonomous robots of claim 20, further comprising: navigating the autonomous robot towards a target location; requesting the updated location from the base station when the autonomous robot is at the target location according to the estimated location on the virtual map; and adjusting the position of the autonomous robot to the target location using the updated location if the difference between the estimated location and the updated location is above a position error threshold.
24. The error-correcting method for precision navigation of autonomous robots of claim 23, further comprising requesting a second updated location from the base station after adjustment in order to confirm that the autonomous robot is at the target location.
25. The error-correcting method for precision navigation of autonomous robots of claim 20, further comprising requesting an updated location from the base station, where the base station is a closest base station to the autonomous robot out of a plurality of base stations.
26. The error-correcting method for precision navigation of autonomous robots of claim 20, further comprising updating the plurality of sensors to reduce measurement error using the estimated location and the updated location.
27. The error-correcting method for precision navigation of autonomous robots of claim 20, wherein the autonomous robot is a wheeled robot.
28. The error-correcting method for precision navigation of autonomous robots of claim 20, further comprising: locating a third optical beacon and a fourth optical beacon using the second camera module and the second rotating holder, where the third and fourth optical beacons have known coordinates; measuring a distance from the base station to the third optical beacon and a distance from the base station to the fourth optical beacon using the measurement module; and calculating the position of the base station by applying a triangulation method using the second processor.
29. An error-correcting navigation system for autonomous robots, comprising: an autonomous robot, comprising: a first camera module housed in a first rotating holder; a first optical beacon; a first transceiver; a plurality of sensors capable of acquiring motion data; and a first processor configured to: navigate the autonomous robot to a target location in a virtual map; estimate the location of the autonomous robot in the virtual map based on the motion data; orient the first rotating holder such that the camera module is pointed at a base station by tracking a second optical beacon on top of the base station using the camera module; and the base station, comprising: the second optical beacon; a second camera module housed in a second rotating holder; a measurement module housed in the second rotating holder capable of accurately measuring the distance to a target; a second transceiver; and a second processor configured to: receive the estimated location of the autonomous robot using the second transceiver; orient the second rotating holder such that the second camera module and the measurement module are pointed at the first optical beacon by tracking the first optical beacon using the second camera module; measure a current distance between the base station and the autonomous robot using the measurement module and the first optical beacon; calculate an updated location of the autonomous robot in the virtual map using the current distance and a rotation angle of the second rotating holder; and transmit the updated location of the autonomous robot to the autonomous robot using the second transceiver; wherein the first processor is further configured to: receive the updated location from the base station using the first transceiver; update the estimated location to be the updated location using a rotation angle of the first rotating holder; update the plurality of sensors to reduce measurement error using the estimated location and the updated location; and adjust the position of the robot to the target location if the difference between the updated location and the estimated location is not below a position error threshold.
30. The error-correcting navigation system for autonomous robots of claim 29, wherein the second processor is further configured to: locate a third optical beacon and a fourth optical beacon using the second camera module and the second rotating holder, where the third and fourth optical beacons have known coordinates; measure a distance from the base station to the third optical beacon and a distance from the base station to the fourth optical beacon using the measurement module; and calculate the position of the base station by applying a triangulation method.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
[0045]
[0046]
[0047]
[0048]
[0049] The objective implementation, functional features and advantages of this invention are further illustrated with reference to the accompanying drawings by using the embodiments.
DETAILED DESCRIPTION
[0050] To make the technical problems to be solved by the present invention, technical solutions, and advantageous effects clearer and more comprehensible, the following further describes the present invention in detail with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely used to explain the present invention but are not intended to limit the present invention.
[0051] As shown in
[0052] Based on the above vehicle navigation positioning system, the following specific implementations are proposed.
Embodiment 1
[0053] As shown in
[0054] S101: Establish communication connection with an autonomous driving system of a vehicle and send driving planned route information to the unmanned vehicle.
[0055] The unmanned vehicle can only achieve unmanned automatic driving on a preset planned route by integrating the autonomous driving system, and the autonomous driving system includes a plurality of sensors including long-range radar, laser radar, short-range radar, a vehicle-mounted camera, ultrasonic waves, GPS, a gyroscope, etc. Each sensor constantly generates data during running, and the system has a high real-time processing requirement for the data generated by each sensor. For example, the camera needs to reach a frame rate of 60 FPS, which means that each frame is processed only for 16 milliseconds to the maximum. But after a data size is increased, system resource allocation becomes a problem. For example, when a mass of laser radar point cloud data enters the system and fully occupies CPU resources, it is possible that data of the camera cannot be processed in time, consequently, the autonomous driving system misses traffic light recognition, and serious consequence are caused. Thus, reasonably selecting a computing platform for real-time large-scale sensing data processing and performing real-time driving early warning and decision making are of vital importance for safety, reliability and continuity of unmanned driving. The computing platform also needs to give consideration of power consumption, heat dissipation, hardware volume, and the like while providing high-perform data processing support, which is similarly important for continuous safe driving. Thus, various hardware modules have related integrated solutions in an existing unmanned vehicle computing platform. Different computing units are connected through Switch or PCIe Switch for data exchange, thereby finishing collaborative operation. In autonomous driving, computing and decision making need to be performed on sensor data related to intelligent driving. In addition, cooperative control of mechanical components in a traditional vehicle is also needed to finish driving operation executing and transforming. This needs the assistance of a control platform Electronic Control Unit (ECU) and a communication bus. The ECU is a special vehicle microcomputer controller in purpose, uses a set of fixed programs with accurate computing and a mass of experiment data as a basis for constantly comparing and computing data of the mechanical part sensors, and then gives instructions to finish mechanical control. The communication bus such as a controller area network (CAN), a universal serial bus (USB) 3.0 and a local interconnect network (LIN) achieves vehicle data sharing and effective instruction transmitting in this process.
[0056] The autonomous driving system has powerful sensor perception capability and corresponding data processing capability; and generally, the computing platform integrated in the autonomous driving system can perform driving planning according to a user driving plan and generate driving planned route information. To reduce redundancy and hardware costs of the autonomous driving system, the server may be connected with the autonomous driving system, and then receives an unmanned vehicle navigation positioning service request reported by the autonomous driving system; the unmanned vehicle navigation positioning service request reported by the terminal and other devices is acquired; and driving planning is performed on the server side, and then the driving planned route information is generated and issued to the autonomous driving system.
[0057] S102: Receive navigation positioning parameters reported by the autonomous driving system, and calculate a positioning error value accumulated during unmanned vehicle driving according to the navigation positioning parameters.
[0058] The autonomous driving system acquires the navigation positioning parameters of the unmanned vehicle in real time through multi-sensor fusion and multi-navigation-manner fusion of inertial navigation, electronic signal positioning, environment characteristic matching, etc.; and since certain positioning errors will be formed due to the navigation manners and noise of the sensors, as time goes on, the errors are constantly accumulated, and as a result, a positioning error value is higher and higher. The unmanned vehicle reports the navigation positioning parameters to the server in real time, and the server performs calculation according to the navigation positioning parameters to acquire the positioning error values in the navigation positioning process.
[0059] S103: Send a navigation correction executing instruction to the unmanned vehicle when the positioning error value reaches a positioning error threshold.
[0060] We know that with the positioning error value becoming higher and higher, it is inevitable that the driving route of the unmanned vehicle has certain deviation, while in some application scenarios, the unmanned vehicle needs to reach an assigned location for operation, and this demand has an extremely high demand for working area precision, which cannot be achieved due to the high positioning error. In this case, under the situation that a positioning precision requirement is met, a certain positioning error threshold is preset, the server compares the accumulated positioning error value with the positioning error threshold, and when the positioning error threshold is reached, the server sends the navigation correction executing instruction to the unmanned vehicle; and the navigation positioning parameters of the unmanned vehicle are corrected according to a preset navigation correction manner so as to eliminate the positioning error value.
[0061] Specifically, a plurality of navigation correcting base stations are arranged in a driving area of the unmanned vehicle and have fixed coordinate information marked in an electronic map corresponding to the driving area, the electronic map is synchronized to the autonomous driving system and the server, and before the step of sending the navigation correction executing instruction to the unmanned vehicle, the server inquiries about the navigation correcting base station closest to the current location of the unmanned vehicle according to the driving planned route information. The navigation correcting base stations can make the unmanned vehicle acquire relative location information with higher precision relative to coordinate information of the navigation correcting base stations in a physical socket manner, visual positioning, optical ranging, and the like. This information serves as navigation correcting parameters, and the autonomous driving system can modify current navigation positioning parameters according to the navigation correcting parameters so as to eliminate the positioning error value.
[0062] In addition, the server may also establish communication connection with the navigation correcting base station, receives the navigation correcting parameters, reported by the navigation correcting base station, of the unmanned vehicle, and modifies the navigation positioning parameters according to the navigation correcting parameters. The positioning error value accumulated during unmanned vehicle driving is re-calculated according to the corrected navigation positioning parameters. By fixing the external navigation correcting parameters provided by the navigation correcting base stations as reference, the unmanned vehicle can correct the error generated due to noise accumulation, and achieves the highest millimeter-level positioning precision on the premise of ensuring the lowest precision requirement.
Embodiment 2
[0063] As shown in
[0064] S201: Receive driving planned route information issued by a server and report navigation positioning parameters to the server.
[0065] To reduce redundancy and hardware costs of an autonomous driving system, a navigation positioning system includes the server, the unmanned vehicle, and a navigation correcting base station, performs driving planning on a server side, generates and issues the driving planned route information and a positioning error value calculated via monitoring to the autonomous driving system. Specifically, the autonomous driving system receives the driving planned route information issued by the server, the unmanned vehicle runs according to the driving planned route information, and a navigation positioning device of the autonomous driving system acquires the navigation positioning parameters in real time and reports the navigation positioning parameters to the server.
[0066] S202: Receive a navigation correction executing instruction issued by the server when the positioning error value accumulated during unmanned vehicle driving reaches a positioning error threshold.
[0067] The server calculates the positioning error value in the navigation positioning process according to the navigation positioning parameters, and when the positioning error value reaches the positioning error threshold, the server issues the navigation correction executing instruction to the unmanned vehicle.
[0068] S203: Establish communication connection with the navigation correcting base station according to the navigation correction executing instruction, acquire navigation correcting parameters through the navigation correcting base station and report the navigation correcting parameters to the server.
[0069] The server inquiries about the navigation correcting base station closest to the current location of the unmanned vehicle according to the driving planned route information, coordinate information of the navigation correcting base station is integrated in the navigation correction executing instruction, and the server establishes communication connection with the navigation correcting base station according to the navigation correction executing instruction; or the autonomous driving system searches for communication signals of the navigation correcting base station in manners such as a wireless communication broadcast manner so as to seek communication signal connection with the navigation correcting base station. The navigation correcting base stations can make the unmanned vehicle acquire relative location information with higher precision relative to coordinate information of the navigation correcting base stations in a physical socket manner, visual positioning, optical ranging, and the like. This information serves as navigation correcting parameters, and the autonomous driving system can modify current navigation positioning parameters according to the navigation correcting parameters so as to eliminate the positioning error value.
Embodiment 3
[0070] As shown in
[0071] S301: Receive a navigation positioning service request and generate driving planned route information.
[0072] When an autonomous driving system of the unmanned vehicle has enough system resources and calculating capability,
[0073] an electronic map with coordinate information of navigation correcting base stations is directly stored in the autonomous driving system, communication connection with the autonomous driving system is established at an input end of the autonomous driving system or through a terminal, the navigation positioning service request, namely a driving destination of a user, is inputted by the input end or a terminal interface to the unmanned vehicle, and the autonomous driving system generates the driving planned information according to the navigation positioning service request.
[0074] S302: Collect navigation positioning parameters, and calculate a positioning error value accumulated during unmanned vehicle driving according to the navigation positioning parameters.
[0075] The autonomous driving system acquires the navigation positioning parameters of the unmanned vehicle in real time through multi-sensor fusion and multi-navigation-manner fusion of inertial navigation, electronic signal positioning, environment characteristic matching, etc.; and the autonomous driving system calculates the positioning error value in the navigation positioning process according to the navigation positioning parameters.
[0076] S303: Inquire about a closest navigation correcting base station according to the driving planned route information when the positioning error value accumulated during unmanned vehicle driving reaches a positioning error threshold.
[0077] The autonomous driving system searches for communication signals of the navigation correcting base station according to the electronic map combined with the driving route information or through wireless communication broadcast or other manners so as to seek communication signal connection with the navigation correcting base station.
[0078] S304: Establish communication connection with the navigation correcting base station, acquire navigation correcting parameters through the navigation correcting base station and modify the navigation positioning parameters according to the navigation correcting parameters.
[0079] The navigation correcting base stations can make the unmanned vehicle acquire relative location information with higher precision relative to coordinate information of the navigation correcting base stations in a physical socket manner, visual positioning, optical ranging, and the like. This information serves as navigation correcting parameters, and the autonomous driving system can modify current navigation positioning parameters according to the navigation correcting parameters so as to eliminate the positioning error value.
Embodiment 4
[0080] An embodiment of the present invention further provides a vehicle navigation positioning method applied to a navigation correcting base station, including:
[0081] receiving a connection request of an unmanned vehicle, generating navigation correcting parameters of the unmanned vehicle and transmit the navigation correcting parameters to the unmanned vehicle; or receiving a connection request of an unmanned vehicle, generating navigation correcting parameters of the unmanned vehicle and transmitting the navigation correcting parameter to the unmanned vehicle and a server.
[0082] There are various types of navigation correcting base stations, for example, fixed positioning sockets distributed in a driving area are adopted, a positioning socket is arranged in the driving area through a stand column, a ground and other manners like an automatic charging manner of an indoor robot mop, a positioning plug connector is correspondingly arranged on the unmanned vehicle, the socket may adopt a conical structure with a large opening so that the positioning plug connector can be smoothly combined with the positioning socket even when the unmanned vehicle has a higher positioning error value, and accordingly, the unmanned vehicle has the accurate navigation positioning parameters in the navigation correcting base station, thereby achieving the purpose of navigation correcting. For another example, a positioning socket, a positioning plug connector and a visual positioning recognition system are combined. Through the visual positioning recognition system, when closing to the navigation correcting base station, real-time navigation positioning parameters of the unmanned vehicle are corrected so that the positioning socket and the positioning plug connector can be combined to achieve the purpose of navigation correcting. For another example, the navigation correcting base station obtains the accurate navigation correcting parameters of the unmanned vehicle relative to the navigation correcting base station in an optical ranging manner and the like, and the navigation positioning parameters of the unmanned vehicle are corrected according to the navigation correcting parameters.
[0083] When the vehicle navigation positioning system includes the unmanned vehicle and the navigation positioning base station, the navigation positioning base station establishes communication connection with the autonomous driving system of the unmanned vehicle and corrects the navigation positioning parameters with the autonomous driving system.
[0084] When a vehicle navigation positioning system includes the unmanned vehicle, the server and the navigation positioning base station, the navigation positioning base station may establish communication connection with at least one of the autonomous driving system of the unmanned vehicle and the server, and reports the navigation correcting parameters to at least one of the autonomous driving system and the server, and the server or the autonomous driving system modifies the navigation positioning parameters according to the navigation correcting parameters.
Embodiment 5
[0085] As shown in
[0086] a communication module 11 configured to establish communication connection with a navigation correcting base station;
[0087] an optical module 12 configured to reversely search for beacons on the navigation correcting base station and determine an orientation of the navigation correcting base station; and
[0088] a holder module 13 configured to install the optical module and calculate a course angle of the unmanned vehicle according to a rotation angle of the holder module.
[0089] Specifically, as shown in
Embodiment 6
[0090] As shown in
[0091] a communication module 21 configured to establish communication connection with the unmanned vehicle;
[0092] an optical ranging module 22 configured to search for a beacon on the unmanned vehicle and measure a distance between the navigation correcting base station and the beacon; and
[0093] a holder module 23 configured to install the optical ranging module and acquire a rotation angle of the holder module.
[0094] As shown in
Embodiment 7
[0095] As shown in
[0096] an inertial navigation positioning module 30 integrated in an autonomous driving system and configured to acquire navigation positioning parameters of an unmanned vehicle 100 in real time;
[0097] a navigation correcting base station 20, at least one navigation correcting base station 20 being arranged in a driving area of the unmanned vehicle 100, configured to measure a real-time location of the unmanned vehicle 100 and acquire navigation correcting parameters; and
[0098] a navigation correcting apparatus 10 installed on each unmanned vehicle 100 and configured to establish communication connection with the navigation correcting base station 20 and be matched with the navigation correcting base station 20 to acquire the navigation correcting parameters.
[0099] The embodiments of the present invention adopt an inertial navigation manner, a three-dimension polar coordinate location is adopted in inertial navigation, a wheel rotating speed and a three-axis angular speed need to be collected, and a current line speed and a current angular speed of the vehicle are calculated according to a vehicle kinematics model; and positioning can be achieved just according to self-information without acquiring information from the outside. Due to this characteristic, the system deploying difficulty and costs can be greatly reduced; but the defect is that the positioning precision is hard to guarantee along with error accumulation. For such defect, the embodiments of the present invention adopt a coarse positioning and fine positioning combined manner for positioning; and within a certain distance, an inertial navigation scheme is directly adopted as rough positioning, and when errors are accumulated, positioning correcting of the navigation correcting base station is adopted as fine positioning to eliminate the errors, thereby guaranteeing precision.
[0100] The embodiments of the present invention adopt monocular optical ranging, a static navigation correcting base station with a ranging function is deployed at an existing location, and an optical ranging module captures a distance and angle relation of the unmanned vehicle and measures accurate coordinates of the unmanned vehicle. Optical ranging precision is far higher than that of an electronic signal ranging technology, and a demand for high precision can be met.
[0101] The navigation correcting base station 20 is a fixed base station capable of being rapidly deployed and configured to accurately position the unmanned vehicle 100; and the unmanned vehicle 100 is a mobile device with the inertial navigation positioning module 30 and can achieve rough positioning by calculating device displacement. The rough positioning is performed by the inertial navigation system in the unmanned vehicle to acquire current rough location information in real time, the fixed navigation correcting base station with the known location searches for the unmanned vehicle when high precision is needed to measure a relative location between the unmanned vehicle and the navigation correcting base station, and the coordinates of the unmanned vehicle are corrected according to external feedback, thereby guaranteeing that a positioning error is within a certain degree, and a high-precision positioning requirement in an assigned area is met.
[0102] The autonomous driving system of the unmanned vehicle 100 acquires a Computer-Aided Design (CAD) map of a located environment in advance, and generates an XY two-dimensional Cartesian coordinate system based on an electronic map; the navigation correcting base station is arranged at a preset location of the driving area first, an angle is leveled to make the optical ranging module located in a vertical direction to reduce a ranging error caused by inclination, two points with known coordinates are sought nearby the navigation correcting base station 20 for placement of two optical beacons correspondingly, and the coordinates of the navigation correcting base station 20 are determined by a triangular positioning method to deploy the navigation correcting base station 20.
[0103] After the unmanned vehicle 100 starts, the navigation correcting base station 20 performs ranging and positioning to accurately acquire a current location of the unmanned vehicle 100; and the unmanned vehicle 100 applies the inertial navigation positioning module 30 to record navigation positioning parameters including a three-axis acceleration speed, a three-axis angular speed and a current attitude angle in real time, and running paths are calculated according to the parameters to obtain real-time rough positioning of the unmanned vehicle 100. After advancing by a long distance, the unmanned vehicle 100 need to stop advancing and is subjected to fine positioning by the navigation correcting base station 20 again to correct the current coordinates. After reaching a high-precision target point, the unmanned vehicle 100 is subjected to fine positioning, and if the distance from the target is less than a certain threshold after correcting, the inertial navigation positioning module 30 finishes a final section of distance; and if the distance is greater than the threshold, the above correcting process is repeated. It can be understood as that when a running distance of the unmanned vehicle 100 is less than this threshold, an error generated by inertial navigation can be ignored.
[0104] As shown in
Embodiment 8
[0105] An embodiment of the present invention further provides a computer-readable storage medium, having vehicle navigation positioning programs stored thereon, the vehicle navigation positioning programs, when being executed by a processor, implementing the steps of the vehicle navigation positioning method applied to a server side, and/or implementing the steps of the vehicle navigation positioning method applied to an unmanned vehicle, and the steps of the vehicle navigation positioning method applied to a navigation correcting base station.
INDUSTRIAL APPLICABILITY
[0106] According to the vehicle navigation positioning method, apparatus, base station and system and the readable storage medium provided by the embodiments of the present invention, the navigation correcting base station is arranged in the driving area of the unmanned vehicle, the unmanned vehicle runs according to the driving planned route of the electronic map in the inertial navigation manner and/or the electronic signal positioning manner, the accumulated error value in the navigation positioning process is calculated, the navigation correcting base station is adopted to eliminate the accumulated error value and correct the navigation positioning parameters, the navigation correcting base station makes the unmanned vehicle acquire an accurate coordinate parameter through a high-precision optical ranging manner, image recognition and other environmental perception sensors or a manner of mechanical socket for positioning, or other manners so that the unmanned vehicle can constantly correct errors in the driving process, and when entering a working area, has a positioning precision level required by operation so as to be applicable to application scenarios with accurate positioning requirements.
[0107] Through the descriptions of the foregoing implementations, a person skilled in the art may clearly understand that the methods in the foregoing embodiments may be implemented by means of software and a necessary general hardware platform, and certainly, may also be implemented by hardware, but in many cases, the former manner is a better implementation. Based on such an understanding, the technical solutions of the present invention essentially, or the part that makes contributions to the prior art may be embodied in the form of a software product. The computer software product is stored in a computer-readable storage medium (such as, a ROM/RAM, a magnetic disk, and an optical disc), and includes several instructions to enable a terminal device (which may be a mobile phone, a computer, a server, an air conditioner or a network device) to perform the vehicle navigation positioning method according to the embodiments of the present invention.
[0108] The foregoing describes preferred embodiments of the present invention with reference to the accompanying drawings, and does not limit the scope of the present invention. Any modification, equivalent replacement, and improvement made by a person skilled in the art without departing from the scope and essence of the present invention shall fall within the scope of the claims of the present invention.