WO2022218306A1 - Unmanned driving device - Google Patents

Unmanned driving device Download PDF

Info

Publication number
WO2022218306A1
WO2022218306A1 PCT/CN2022/086368 CN2022086368W WO2022218306A1 WO 2022218306 A1 WO2022218306 A1 WO 2022218306A1 CN 2022086368 W CN2022086368 W CN 2022086368W WO 2022218306 A1 WO2022218306 A1 WO 2022218306A1
Authority
WO
WIPO (PCT)
Prior art keywords
positioning
satellite
deviation
unmanned
area
Prior art date
Application number
PCT/CN2022/086368
Other languages
French (fr)
Chinese (zh)
Inventor
董峻峰
何祎
李秋成
胡增科
申浩
夏华夏
Original Assignee
北京三快在线科技有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 北京三快在线科技有限公司 filed Critical 北京三快在线科技有限公司
Publication of WO2022218306A1 publication Critical patent/WO2022218306A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42Determining position

Definitions

  • the present application relates to the field of unmanned driving technology, and in particular, to an unmanned driving device.
  • the location of the unmanned equipment is usually determined in real time based on a satellite positioning system such as the Global Positioning System (GPS).
  • GPS Global Positioning System
  • other sensor devices such as Inertial Measurement Unit (IMU), etc., need to be used to assist positioning.
  • IMU Inertial Measurement Unit
  • the GPS sensor configured on the unmanned vehicle can receive the satellite signals of multiple positioning satellites, and according to the received The satellite signals of the multiple positioning satellites are determined, and the signal transmission duration of the multiple positioning satellites and the position information of the multiple positioning satellites are determined. Finally, the location of the unmanned vehicle is determined according to the location information of the multiple positioning satellites and the transmission duration of the signals transmitted to the unmanned vehicle.
  • Embodiments of the present disclosure provide a method and device for positioning an unmanned device.
  • a method for positioning an unmanned vehicle provided by the present disclosure includes:
  • the confidence level of the current satellite positioning result of the unmanned device is determined, wherein the positioning deviation function is based on historical The proportion of unobstructed satellite signals in multiple areas and the positioning deviation in multiple areas are obtained by fitting;
  • the unmanned device is fused to locate the unmanned device, and the fused positioning position of the unmanned device is determined.
  • determining the confidence level of the current satellite positioning result performed by the unmanned device specifically includes:
  • the positioning deviation function determines the positioning deviation of the satellite positioning performed by the unmanned device in the target area
  • the confidence level of the result of the current satellite positioning performed by the unmanned device is determined.
  • the current satellite positioning position of the unmanned device and the confidence level of the current satellite positioning result perform fusion positioning on the unmanned device, and determine the fusion positioning position of the unmanned device, Specifically include:
  • the fusion positioning position of the unmanned device is determined according to other positioning methods.
  • the method further includes:
  • the second positioning deviation of the satellite positioning in the target area in the history is updated.
  • updating the historical second positioning deviation of satellite positioning in the target area including:
  • the second positioning deviation of the satellite positioning performed in the target area in the history is updated.
  • fit a positioning deviation function including:
  • the positioning deviation function is obtained by fitting according to the proportion of the unobstructed satellite signals in the multiple regions and the positioning deviation generated in the multiple regions.
  • the obstacle information of one or more obstacles corresponding to the area determine the proportion of areas in the area that receive satellite signals that are not blocked by obstacles, including:
  • the obstacle information of one or more obstacles corresponding to the area determine the angular range in which the satellite signal is received at the center point of the area without being blocked by obstacles;
  • the present disclosure provides a positioning device for unmanned equipment, including:
  • the area determination module determines the target area where the unmanned equipment is currently located
  • the confidence level determination module determines the confidence level of the current satellite positioning result performed by the unmanned device according to the proportion of the unobstructed satellite signal in the target area and the pre-fitted positioning deviation function, wherein the positioning The deviation function is fitted according to the proportion of unobstructed satellite signals in multiple regions in history and the positioning deviation in multiple regions;
  • a satellite positioning module for determining the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites
  • the fusion positioning module performs fusion positioning on the unmanned equipment according to the current satellite positioning position of the unmanned equipment and the confidence level of the current satellite positioning result, and determines the fusion positioning position of the unmanned equipment.
  • the present disclosure provides a computer-readable storage medium, where a computer program is stored in the storage medium, and when the computer program is executed by a processor, the above-mentioned positioning method for an unmanned vehicle is implemented.
  • An unmanned device provided by the present disclosure includes a memory, a processor, and a computer program stored in the memory and executable on the processor, and the processor implements the above-mentioned positioning method for the unmanned device when the program is executed. .
  • the positioning deviation function is obtained in advance based on the proportion of the regions in which the satellite signals are not blocked in the history and the positioning deviation in the multiple regions.
  • the confidence of the current satellite positioning result can be determined according to the proportion of the unobstructed satellite signal in the target area where the unmanned device is currently located, and the pre-fitted positioning deviation function. Spend.
  • the unmanned equipment is fused and positioned.
  • FIG. 1 is a schematic flowchart of a method for locating an unmanned device according to an embodiment of the present disclosure
  • 2A-2B are schematic diagrams of determining the proportion of unobstructed satellite signal areas in a target area according to an embodiment of the present disclosure
  • FIG. 3 is a schematic diagram of updating result confidence based on incremental deviation according to an embodiment of the present disclosure
  • FIG. 4 is a schematic structural diagram of a positioning device for an unmanned device according to an embodiment of the present disclosure
  • FIG. 5 is a schematic diagram of an unmanned device for implementing a method for positioning an unmanned device according to an embodiment of the present disclosure.
  • the present disclosure provides a positioning method for an unmanned device, as shown in FIG. 1 .
  • FIG. 1 is a schematic flowchart of a method for locating an unmanned device according to an embodiment of the present disclosure, which may specifically include the following steps:
  • S100 Determine the target area where the unmanned device is currently located.
  • the unmanned device may be a device such as an unmanned vehicle, a drone, and a robot.
  • the position of the unmanned device during the driving process can be determined in real time.
  • the current position of the unmanned device may be roughly determined first. After that, according to the current position of the unmanned device and the corresponding position ranges of the pre-divided areas, determine the target area where the unmanned device currently falls, that is, the target area where the unmanned device is currently located. .
  • the pre-divided areas can be divided according to the unit range, for example, the ground area is divided into several squares with a side length of 5 meters.
  • the current position of the unmanned device can be roughly determined according to the latest positioning result of the unmanned device in the history.
  • any existing positioning method can also be used to roughly determine the position of the unmanned device, such as base station positioning, satellite positioning, and lidar positioning, etc., which are not limited in this disclosure, and can be set as required. .
  • S102 Determine the confidence level of the current satellite positioning result performed by the unmanned device according to the proportion of the area in the target area that does not block satellite signals and the pre-fitted positioning deviation function.
  • the satellite positioning of the unmanned device after roughly determining the target area where the unmanned device is located, it can be determined whether the satellite positioning of the unmanned device is accurate according to the occlusion of the satellite signal by the target area. .
  • the area proportion of the unobstructed satellite signals in the target area can be determined from the pre-stored area proportions of the unobstructed satellite signals corresponding to the multiple areas. Compare. After that, the proportion of the area in the target area that does not block the satellite signal is input into the pre-fitted positioning deviation function to obtain the positioning deviation generated by the satellite positioning of the unmanned vehicle in the target area. Finally, according to the positioning deviation generated by the satellite positioning performed by the unmanned equipment in the target area, the confidence level of the current satellite positioning result of the unmanned equipment is determined.
  • the pre-divided multiple areas refer to multiple grids divided according to the unit range
  • the area that does not block the satellite signal refers to the area where the unmanned device can directly receive the satellite signal, that is, the satellite signal It is directly received by the unmanned device without being blocked by any obstacle.
  • the positioning deviation is negatively correlated with the confidence of the result. The larger the positioning deviation, the smaller the confidence of the result, indicating that the positioning result of the current satellite positioning is inaccurate.
  • the positioning deviation output based on the pre-fitted positioning deviation function may be used as the first positioning deviation.
  • determine the positioning deviation of the satellite positioning of the unmanned equipment in the target area for example, the unmanned equipment is in The positioning deviation of the satellite positioning of the target area may be an average value of the first positioning deviation and the second positioning deviation.
  • the confidence level of the current satellite positioning result of the unmanned device is determined. For example, the positioning deviation of the satellite positioning performed by the unmanned device in the target area is the same as The confidence of the results is negatively correlated, and the greater the positioning deviation, the lower the confidence of the results.
  • S104 Determine the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites.
  • S106 According to the current satellite positioning position of the unmanned device and the confidence level of the current satellite positioning result, perform fusion positioning on the unmanned device, and determine the fusion positioning position of the unmanned device.
  • the positioning method provided by the present disclosure can determine the precise position of the unmanned device based on the confidence of the current satellite positioning result of the unmanned device.
  • the unmanned device can receive satellite signals of multiple satellites through the GPS sensor configured by itself, and determine the current status of the unmanned device by means of satellite positioning based on the received satellite signals of multiple satellites. Satellite positioning location.
  • the fusion positioning can be performed according to the satellite positioning position determined by the satellite positioning method and other positioning methods, and the fusion positioning position of the unmanned device can be determined. Among them, the fusion positioning position is the more accurate position of the unmanned device.
  • the preset threshold can be set as required, for example, set to 0.5.
  • the other positioning manner may be one or more of IMU positioning, lidar positioning, and visual positioning, which is not limited in the present disclosure.
  • the embodiment of the present disclosure obtains the positioning deviation function in advance based on the proportion of the regions in which the satellite signals are not blocked in the history and the positioning deviation in the multiple regions.
  • the confidence of the current satellite positioning result can be determined according to the proportion of the unobstructed satellite signal in the target area where the unmanned device is currently located, and the pre-fitted positioning deviation function. Spend.
  • the unmanned equipment is fused and positioned.
  • one or more obstacles corresponding to the area may be determined first. , that is, one or more obstacles around the area or inside the area. Then, according to the obstacle information of one or more obstacles corresponding to the area, such as position information and altitude information, etc., determine the angular range in which the satellite signal is received at the center point of the area without being blocked by the obstacle. Finally, according to the angular range of the received satellite signal at the center point of the area that is not blocked by obstacles, the proportion of the area in which the received satellite signal is not blocked by obstacles is determined.
  • FIG. 2A-2B are schematic diagrams of determining the proportion of unobstructed satellite signal areas in a target area according to an embodiment of the present disclosure.
  • FIG. 2A for the target area where the unmanned device is currently located, there are buildings with different heights on both sides of the target area, and the buildings are obstacles that block satellite signals in the target area.
  • the ideal signal receiving area is that there are no obstacles blocking the satellite signal within a range of 180 degrees in the front, rear, left and right.
  • there are usually no obstacles that block satellite signals in the direction of road extension so satellite signals received in the range of -90° to 90° in the direction of road extension are not blocked by obstacles.
  • some angles in the direction perpendicular to the road are blocked.
  • the obstacle information such as the position and height of the obstacle corresponding to the target area, it can be determined that the angle range of the satellite signal received by the target area not blocked by the obstacle in the vertical road direction is - ⁇ ° ⁇ °.
  • a two-dimensional polar coordinate system is established with the angular ranges of receiving satellite signals in two different directions, "road extension direction” and “vertical road direction” as coordinate axes.
  • the angular range -90° ⁇ 90° when the satellite signal is not blocked by obstacles in the direction of road extension and the angular range - ⁇ ° ⁇ 90° when the satellite signal is received in the vertical direction of the road and not blocked by obstacles ⁇ °, to determine the area that does not block the satellite signal and the proportion of the area in the target area.
  • the blank area represents the area where the satellite signal is not blocked
  • the gray filled area represents the area where the obstacle blocks the satellite signal.
  • the pre-fitted positioning deviation function in the present disclosure can be obtained by fitting based on the proportion of the regions in which the satellite signals are not blocked in the history and the positioning deviation in the multiple regions.
  • the positioning deviation function historical positioning deviations generated by satellite positioning in a plurality of pre-divided regions can be obtained first. Afterwards, for each of the pre-divided areas, the proportion of the area in which the satellite signal is received and not blocked by the obstacle may be determined according to the obstacle information of one or more obstacles corresponding to the area. Finally, according to the proportion of unobstructed satellite signals in multiple regions, and the positioning deviation generated in multiple regions, the positioning deviation function is obtained by fitting. The specific manner of determining the proportion of the areas in which the received satellite signals are not blocked by obstacles has been described in detail above, and will not be repeated in the present disclosure.
  • the proportion of the areas that do not block satellite signals in the multiple areas to be driven by the unmanned device can be pre-determined offline, and the positioning deviation function can be pre-fitted.
  • the proportion of the unobstructed satellite signal area in the target area where the unmanned vehicle is currently located can be directly determined from the pre-stored area proportions of the unobstructed satellite signals corresponding to the multiple areas, and based on the The proportion of the unobstructed satellite signal area in the target area, and the pre-fitted positioning deviation function, determine the positioning deviation of satellite positioning in the target area.
  • the calculation amount required for positioning is reduced, and the real-time performance of positioning is improved.
  • step S106 of the present disclosure after the position of the unmanned device is accurately determined by the fusion positioning method, the satellite positioning position obtained by the satellite positioning method can be corrected according to the precise fusion positioning position.
  • the incremental deviation of satellite positioning in the target area can be determined according to the fusion positioning position of the unmanned device, the satellite positioning position, and the positioning deviation of satellite positioning in the target area.
  • update the second positioning deviation of satellite positioning in the target area in the history so as to correct the satellite positioning in the target area according to the second positioning deviation The resulting positioning error.
  • the unmanned device can determine its own satellite positioning position based on the received satellite signals, and based on the current satellite positioning position and the confidence of the satellite positioning result,
  • the human-driving device performs fusion positioning to determine the fusion positioning position.
  • the confidence of the satellite positioning result may be determined based on the first positioning deviation output by the fitted positioning deviation function and the second positioning deviation determined in the target area in the history.
  • the incremental deviation generated by satellite positioning in the target area can be determined according to its own fusion positioning position and satellite positioning position, so as to update the second positioning deviation according to the incremental deviation, and then update the second positioning deviation in the target area. Confidence in the result of satellite positioning. Through continuous iterative update, the result confidence of the target area is made more accurate.
  • incremental deviations generated by satellite positioning in the target area for several times in the history may also be obtained, and according to the difference of the incremental deviations generated several times Average, update the second positioning deviation of satellite positioning in the target area in history.
  • the horizontal position deviation also referred to as positioning deviation
  • unit meters the horizontal position deviation of the satellite positioning in the area
  • Step 1 Obtain a fitting function S that is estimated to represent the satellite positioning position error according to the occlusion of the sky.
  • the fitting function S is a positioning deviation function.
  • each sample data contains satellite positioning position (x, y), real position (x', y'), and the proportion of unobstructed satellite signal area p.
  • the true location may be a fused location location.
  • the sample data is further processed to obtain a sample point whose abscissa is p and the ordinate is the satellite horizontal positioning deviation value d.
  • the value range of p may be [0.0, 1.0]
  • Step 2 When drawing a map for the first time, record the horizontal position deviation d of satellite positioning.
  • the map is rasterized in the horizontal direction to obtain multiple grids. For each grid Ci (i is the grid number), calculate the proportion pi of the unobstructed satellite signal area at this grid position.
  • Step 3 Constantly correct the estimated satellite position error in the map during the actual operation of the map.
  • the unmanned equipment when the unmanned equipment is in the grid Ci, the observed satellite positioning results (xi,yi) and the vehicle fusion positioning position (xi",yi") at that time, and calculate the horizontal position of the satellite positioning Incremental deviation di'.
  • corrections are made to the satellite position error estimates recorded in raster Ci.
  • the estimated value of the original satellite horizontal position error recorded in Ci is di(old).
  • di(old) can be corrected according to a fixed correction coefficient ⁇ , and the correction amount is ⁇ *(average-di(old)).
  • the coefficient ⁇ controls the speed of correction, and its value is 0.0 to 1.0 (the recommended value is 0.1 according to engineering experience, which can make the correction amount gradually approach the average, and prevent the di' value from fluctuating violently due to accidental factors).
  • the unmanned equipment can not only obtain the position deviation estimated by the satellite positioning receiver when driving, but also obtain the satellite positioning deviation for the fusion algorithm by directly checking the position of the unmanned equipment.
  • the positioning method shown in this disclosure can be specifically used in the process of unmanned distribution.
  • the unmanned device can determine its own position in real time through the positioning method in this disclosure, so as to determine its own position according to its own
  • the distribution path is planned according to the location, and the distribution task is executed according to the planned path.
  • an embodiment of the present disclosure also provides a schematic structural diagram of a positioning device for an unmanned device, as shown in FIG. 4 .
  • FIG. 4 is a schematic structural diagram of a positioning device for an unmanned device provided by an embodiment of the present disclosure, including:
  • the area determination module 200 determines the target area where the unmanned device is currently located
  • the confidence level determination module 202 determines the confidence level of the current satellite positioning result performed by the unmanned device according to the proportion of the unobstructed satellite signal in the target area and the pre-fitted positioning deviation function, wherein the The positioning deviation function is fitted according to the proportion of unobstructed satellite signals in multiple regions in history and the positioning deviation in multiple regions;
  • the satellite positioning module 204 determines the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites;
  • the fusion positioning module 206 perform fusion positioning on the unmanned equipment, and determine the fusion positioning position of the unmanned equipment .
  • the confidence level determination module 202 is specifically configured to determine the unmanned vehicle according to the first positioning deviation output by the positioning deviation function and the second positioning deviation historically determined in the target area.
  • the positioning deviation of the satellite positioning performed in the target area is determined according to the positioning deviation of the satellite positioning performed by the unmanned device in the target area to determine the confidence level of the current satellite positioning result performed by the unmanned device.
  • the fusion positioning module 206 is specifically configured to determine whether the confidence of the result is greater than a preset threshold, and if so, perform fusion positioning according to the satellite positioning position and other positioning methods to determine the unmanned vehicle. If not, determine the fusion positioning position of the unmanned vehicle according to other positioning methods.
  • the fusion positioning module 206 is further configured to, according to the fusion positioning position of the unmanned equipment and the satellite positioning position of the unmanned equipment, determine the increment of satellite positioning in the target area.
  • the deviation according to the incremental deviation of the satellite positioning in the target area, update the second positioning deviation of the satellite positioning in the target area in the history.
  • the fusion positioning module 206 is further configured to, according to the average value of the incremental deviations of satellite positioning performed in the target area several times in the history, update the number of satellite positioning performed in the history in the target area. Two positioning deviation.
  • the positioning device of the unmanned equipment further includes an offline fitting module 208, and the offline fitting module 208 is specifically configured to acquire the positioning deviations generated by satellite positioning in the pre-divided regions in the history. , for each area of the pre-divided multiple areas, according to the obstacle information of one or more obstacles corresponding to the area, determine the proportion of the area receiving satellite signals that are not blocked by obstacles in the area. The proportion of unobstructed satellite signals in the region and the positioning deviation generated in multiple regions are fitted to obtain the positioning deviation function.
  • the offline fitting module 208 is specifically configured to, according to the obstacle information of one or more obstacles corresponding to the area, determine the angular range in which the satellite signal is received at the center point of the area without being blocked by the obstacle, According to the angular range of receiving satellite signals at the center point of the area that is not blocked by obstacles, determine the proportion of the area where satellite signals are received and not blocked by obstacles in the area.
  • Embodiments of the present disclosure further provide a computer-readable storage medium, where a computer program is stored in the storage medium, and the computer program can be used to execute the method for positioning an unmanned vehicle provided in FIG. 1 .
  • an embodiment of the present disclosure also proposes a schematic structural diagram of the unmanned device shown in FIG. 5 .
  • the driverless device includes a processor, an internal bus, a network interface, a memory, and a non-volatile memory, and of course, it may also include hardware required by other services.
  • the processor reads the corresponding computer program from the non-volatile memory into the memory and runs it, so as to realize the positioning method of the unmanned vehicle shown in FIG. 1 above.
  • a Programmable Logic Device (such as a Field Programmable Gate Array (FPGA)) is an integrated circuit whose logic function is determined by user programming of the device.
  • HDL Hardware Description Language
  • ABEL Advanced Boolean Expression Language
  • AHDL Altera Hardware Description Language
  • HDCal JHDL
  • Lava Lava
  • Lola MyHDL
  • PALASM RHDL
  • VHDL Very-High-Speed Integrated Circuit Hardware Description Language
  • Verilog Verilog
  • the controller may be implemented in any suitable manner, for example, the controller may take the form of eg a microprocessor or processor and a computer readable medium storing computer readable program code (eg software or firmware) executable by the (micro)processor , logic gates, switches, application specific integrated circuits (ASICs), programmable logic controllers and embedded microcontrollers, examples of controllers include but are not limited to the following microcontrollers: ARC 625D, Atmel AT91SAM, Microchip PIC18F26K20 and Silicon Labs C8051F320, the memory controller can also be implemented as part of the control logic of the memory.
  • the controller may take the form of eg a microprocessor or processor and a computer readable medium storing computer readable program code (eg software or firmware) executable by the (micro)processor , logic gates, switches, application specific integrated circuits (ASICs), programmable logic controllers and embedded microcontrollers
  • ASICs application specific integrated circuits
  • controllers include but are not limited to
  • the controller in addition to implementing the controller in the form of pure computer-readable program code, the controller can be implemented as logic gates, switches, application-specific integrated circuits, programmable logic controllers and embedded devices by logically programming the method steps.
  • the same function can be realized in the form of a microcontroller, etc. Therefore, such a controller can be regarded as a hardware component, and the devices included therein for realizing various functions can also be regarded as a structure within the hardware component. Or even, the means for implementing various functions can be regarded as both a software module implementing a method and a structure within a hardware component.
  • a typical implementation device is a computer.
  • the computer can be, for example, a personal computer, a laptop computer, a cellular phone, a camera phone, a smart phone, a personal digital assistant, a media player, a navigation device, an email device, a game console, a tablet computer, a wearable device, or A combination of any of these devices.
  • embodiments of the present invention may be provided as a method, system, or computer program product. Accordingly, the present invention may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, the present invention may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, etc.) having computer-usable program code embodied therein.
  • computer-usable storage media including, but not limited to, disk storage, CD-ROM, optical storage, etc.
  • These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing apparatus to function in a particular manner, such that the instructions stored in the computer-readable memory result in an article of manufacture comprising instruction means, the instructions
  • the apparatus implements the functions specified in the flow or flow of the flowcharts and/or the block or blocks of the block diagrams.
  • a computing device includes one or more processors (CPUs), input/output interfaces, network interfaces, and memory.
  • processors CPUs
  • input/output interfaces network interfaces
  • memory volatile and non-volatile memory
  • Memory may include forms of non-persistent memory, random access memory (RAM) and/or non-volatile memory in computer readable media, such as read only memory (ROM) or flash memory (flash RAM). Memory is an example of a computer-readable medium.
  • RAM random access memory
  • ROM read only memory
  • flash RAM flash memory
  • Computer-readable media includes both persistent and non-permanent, removable and non-removable media, and storage of information may be implemented by any method or technology.
  • Information may be computer readable instructions, data structures, modules of programs, or other data.
  • Examples of computer storage media include, but are not limited to, phase-change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read only memory (ROM), Electrically Erasable Programmable Read Only Memory (EEPROM), Flash Memory or other memory technology, Compact Disc Read Only Memory (CD-ROM), Digital Versatile Disc (DVD) or other optical storage, Magnetic tape cassettes, magnetic tape magnetic disk storage or other magnetic storage devices or any other non-transmission medium that can be used to store information that can be accessed by a computing device.
  • computer-readable media does not include transitory computer-readable media, such as modulated data signals and carrier waves.
  • embodiments of the present disclosure may be provided as a method, system or computer program product. Accordingly, the present disclosure may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, the present disclosure may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, etc.) having computer-usable program code embodied therein.
  • computer-usable storage media including, but not limited to, disk storage, CD-ROM, optical storage, etc.
  • program modules include routines, programs, objects, components, data structures, etc. that perform particular tasks or implement particular abstract data types.
  • the disclosure may also be practiced in distributed computing environments where tasks are performed by remote processing devices that are linked through a communications network.
  • program modules may be located in both local and remote computer storage media including storage devices.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

A positioning method and apparatus for an unmanned driving device. A positioning deviation function is obtained in advance through fitting on the basis of the proportion of regions that do not obstruct satellite signals among multiple regions in history and the positioning deviation in multiple regions. During the positioning of an unmanned driving device, the confidence of results of satellite positioning currently performed can be determined according to the proportion of the regions that do not obstruct satellite signals in a target region where the unmanned driving device is currently located and the pre-fitted positioning deviation function. Furthermore, according to the confidence of the results and the satellite positioning location determined by means of a satellite positioning method, fusion positioning is performed on the unmanned driving device.

Description

一种无人驾驶设备an unmanned vehicle 技术领域technical field
本申请涉及无人驾驶技术领域,尤其涉及一种无人驾驶设备。The present application relates to the field of unmanned driving technology, and in particular, to an unmanned driving device.
背景技术Background technique
目前,在无人驾驶过程中对无人驾驶设备进行定位时,通常基于全球定位系统(Global Positioning System,GPS)等卫星定位系统,实时确定无人驾驶设备的位置。但由于卫星定位的精度不够准确,因此还需采用其他传感器设备,如,惯性测量单元(Inertial Measurement Unit,IMU)等,进行辅助定位。At present, when positioning the unmanned equipment during the unmanned driving process, the location of the unmanned equipment is usually determined in real time based on a satellite positioning system such as the Global Positioning System (GPS). However, since the accuracy of satellite positioning is not accurate enough, other sensor devices, such as Inertial Measurement Unit (IMU), etc., need to be used to assist positioning.
以无人驾驶设备为无人车为例,在基于卫星定位系统确定无人车位置时,可通过该无人车配置的GPS传感器,接收多个定位卫星的卫星信号,并根据接收到的多个定位卫星的卫星信号,确定多个定位卫星的信号传输时长以及多个定位卫星的位置信息。最后,根据多个定位卫星的位置信息以及传输至该无人车的信号传输时长,确定该无人车的位置。Taking the unmanned device as an unmanned vehicle as an example, when the location of the unmanned vehicle is determined based on the satellite positioning system, the GPS sensor configured on the unmanned vehicle can receive the satellite signals of multiple positioning satellites, and according to the received The satellite signals of the multiple positioning satellites are determined, and the signal transmission duration of the multiple positioning satellites and the position information of the multiple positioning satellites are determined. Finally, the location of the unmanned vehicle is determined according to the location information of the multiple positioning satellites and the transmission duration of the signals transmitted to the unmanned vehicle.
发明内容SUMMARY OF THE INVENTION
本公开实施例提供一种无人驾驶设备的定位方法及装置。Embodiments of the present disclosure provide a method and device for positioning an unmanned device.
本公开实施例采用下述技术方案:The embodiment of the present disclosure adopts the following technical solutions:
本公开提供的一种无人驾驶设备的定位方法,包括:A method for positioning an unmanned vehicle provided by the present disclosure includes:
确定无人驾驶设备当前所处目标区域;Determine the target area where the unmanned equipment is currently located;
根据所述目标区域中未遮挡卫星信号的区域占比,以及预先拟合的定位偏差函数,确定所述无人驾驶设备当前进行卫星定位的结果置信度,其中,所述定位偏差函数根据历史上多个区域中未遮挡卫星信号的区域占比以及在多个区域内的定位偏差拟合得到;According to the proportion of the unobstructed satellite signal in the target area and the pre-fitted positioning deviation function, the confidence level of the current satellite positioning result of the unmanned device is determined, wherein the positioning deviation function is based on historical The proportion of unobstructed satellite signals in multiple areas and the positioning deviation in multiple areas are obtained by fitting;
根据接收到的多个卫星的卫星信号,确定所述无人驾驶设备当前的卫星定位位置;Determine the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites;
根据所述无人驾驶设备当前的卫星定位位置,以及当前进行卫星定位的结果置信度,对所述无人驾驶设备进行融合定位,确定所述无人驾驶设备的融合定位位置。According to the current satellite positioning position of the unmanned device and the confidence level of the current satellite positioning result, the unmanned device is fused to locate the unmanned device, and the fused positioning position of the unmanned device is determined.
可选地,确定所述无人驾驶设备当前进行卫星定位的结果置信度,具体包括:Optionally, determining the confidence level of the current satellite positioning result performed by the unmanned device specifically includes:
根据所述定位偏差函数输出的第一定位偏差,以及历史上在所述目标区域确定的第二定位偏差,确定所述无人驾驶设备在所述目标区域进行卫星定位的定位偏差;According to the first positioning deviation output by the positioning deviation function, and the second positioning deviation determined in the history of the target area, determine the positioning deviation of the satellite positioning performed by the unmanned device in the target area;
根据所述无人驾驶设备在所述目标区域进行卫星定位的定位偏差,确定所述无人驾驶设备当前进行卫星定位的结果置信度。According to the positioning deviation of the satellite positioning performed by the unmanned device in the target area, the confidence level of the result of the current satellite positioning performed by the unmanned device is determined.
可选地,根据所述无人驾驶设备当前的卫星定位位置,以及当前进行卫星定位的结果置信度,对所述无人驾驶设备进行融合定位,确定所述无人驾驶设备的融合定位位置,具体包括:Optionally, according to the current satellite positioning position of the unmanned device and the confidence level of the current satellite positioning result, perform fusion positioning on the unmanned device, and determine the fusion positioning position of the unmanned device, Specifically include:
响应于所述结果置信度大于预设阈值,根据所述卫星定位位置以及其它定位方式,进行融合定位,确定所述无人驾驶设备的融合定位位置,其中所述其它定位方式包括IMU定位、激光雷达定位以及视觉定位中的一种或多种;In response to the confidence of the result being greater than a preset threshold, perform fusion positioning according to the satellite positioning position and other positioning methods, and determine the fusion positioning position of the unmanned device, wherein the other positioning methods include IMU positioning, laser positioning One or more of radar positioning and visual positioning;
响应于所述结果置信度小于等于预设阈值,根据其它定位方式,确定所述无人驾驶设备的融合定位位置。In response to the result confidence being less than or equal to a preset threshold, the fusion positioning position of the unmanned device is determined according to other positioning methods.
可选地,所述方法还包括:Optionally, the method further includes:
根据所述无人驾驶设备的融合定位位置以及所述无人驾驶设备的卫星定位位置,确定在所述目标区域内进行卫星定位的增量偏差;Determine the incremental deviation of satellite positioning in the target area according to the fusion positioning position of the unmanned device and the satellite positioning position of the unmanned device;
根据在所述目标区域内进行卫星定位的增量偏差,更新历史上在所述目标区域内进行卫星定位的第二定位偏差。According to the incremental deviation of the satellite positioning in the target area, the second positioning deviation of the satellite positioning in the target area in the history is updated.
可选地,根据在所述目标区域内进行卫星定位的增量偏差,更新历史上在所述目标区域内进行卫星定位的第二定位偏差,包括:Optionally, according to the incremental deviation of satellite positioning in the target area, updating the historical second positioning deviation of satellite positioning in the target area, including:
根据历史上若干次在所述目标区域内进行卫星定位的增量偏差的平均值,更新历史上在所述目标区域内进行卫星定位的第二定位偏差。According to the average value of the incremental deviations of the satellite positioning performed in the target area several times in the history, the second positioning deviation of the satellite positioning performed in the target area in the history is updated.
可选地,拟合定位偏差函数,包括:Optionally, fit a positioning deviation function, including:
获取历史上在预先划分的多个区域内通过卫星定位产生的定位偏差;Obtain the historical positioning deviation generated by satellite positioning in multiple pre-divided areas;
针对所述预先划分的多个区域的每个区域,根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比;For each area of the pre-divided multiple areas, according to the obstacle information of one or more obstacles corresponding to the area, determine the proportion of areas in the area that receive satellite signals that are not blocked by obstacles;
根据所述多个区域内未遮挡卫星信号的区域占比,以及在所述多个区域内产生的定位偏差,拟合得到定位偏差函数。The positioning deviation function is obtained by fitting according to the proportion of the unobstructed satellite signals in the multiple regions and the positioning deviation generated in the multiple regions.
可选地,根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比,包括:Optionally, according to the obstacle information of one or more obstacles corresponding to the area, determine the proportion of areas in the area that receive satellite signals that are not blocked by obstacles, including:
根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域中心点位置接收卫星信号未被障碍物遮挡的角度范围;According to the obstacle information of one or more obstacles corresponding to the area, determine the angular range in which the satellite signal is received at the center point of the area without being blocked by obstacles;
根据在该区域中心点位置接收卫星信号未被障碍物遮挡的角度范围,确定According to the angular range of the received satellite signal at the center of the area that is not blocked by obstacles, determine
在该区域内接收卫星信号未被障碍物遮挡的区域占比。The proportion of the area that receives satellite signals and is not blocked by obstacles in this area.
本公开提供一种无人驾驶设备的定位装置,包括:The present disclosure provides a positioning device for unmanned equipment, including:
区域确定模块,确定无人驾驶设备当前所处目标区域;The area determination module determines the target area where the unmanned equipment is currently located;
置信度确定模块,根据所述目标区域中未遮挡卫星信号的区域占比,以及预先拟合的定位偏差函数,确定所述无人驾驶设备当前进行卫星定位的结果置信度,其中,所述定位偏差函数根据历史上多个区域中未遮挡卫星信号的区域占比以及在多个区域内的定位偏差拟合得到;The confidence level determination module determines the confidence level of the current satellite positioning result performed by the unmanned device according to the proportion of the unobstructed satellite signal in the target area and the pre-fitted positioning deviation function, wherein the positioning The deviation function is fitted according to the proportion of unobstructed satellite signals in multiple regions in history and the positioning deviation in multiple regions;
卫星定位模块,根据接收到的多个卫星的卫星信号,确定所述无人驾驶设备当前的卫星定位位置;a satellite positioning module, for determining the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites;
融合定位模块,根据所述无人驾驶设备当前的卫星定位位置,以及当前进行卫星定位的结果置信度,对所述无人驾驶设备进行融合定位,确定所述无人驾驶设备的融合定位位置。The fusion positioning module performs fusion positioning on the unmanned equipment according to the current satellite positioning position of the unmanned equipment and the confidence level of the current satellite positioning result, and determines the fusion positioning position of the unmanned equipment.
本公开提供的一种计算机可读存储介质,所述存储介质存储有计算机程序,所述计算机程序被处理器执行时实现上述无人驾驶设备的定位方法。The present disclosure provides a computer-readable storage medium, where a computer program is stored in the storage medium, and when the computer program is executed by a processor, the above-mentioned positioning method for an unmanned vehicle is implemented.
本公开提供的一种无人驾驶设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述无人驾驶设备的定位方法。An unmanned device provided by the present disclosure includes a memory, a processor, and a computer program stored in the memory and executable on the processor, and the processor implements the above-mentioned positioning method for the unmanned device when the program is executed. .
本公开实施例采用的上述至少一个技术方案能够达到以下有益效果:The above-mentioned at least one technical solution adopted in the embodiments of the present disclosure can achieve the following beneficial effects:
本公开实施例预先基于历史上多个区域中未遮挡卫星信号的区域占比以及在多个区域内的定位偏差拟合得到定位偏差函数。在对无人驾驶设备进行定位时,可根据该无人驾驶设备当前所处目标区域中未遮挡卫星信号的区域占比,以及该预先拟合的定位偏差函数,确定当前进行卫星定位的结果置信度。并根据该结果置信度以及通过卫星定位方式确定的卫星定位位置,对该无人驾驶设备进行融合定位。通过确定无人驾驶设备当前 进行卫星定位的结果置信度,并基于该结果置信度进行定位,提高了无人驾驶设备定位的准确度。In the embodiment of the present disclosure, the positioning deviation function is obtained in advance based on the proportion of the regions in which the satellite signals are not blocked in the history and the positioning deviation in the multiple regions. When positioning the unmanned device, the confidence of the current satellite positioning result can be determined according to the proportion of the unobstructed satellite signal in the target area where the unmanned device is currently located, and the pre-fitted positioning deviation function. Spend. And according to the confidence of the result and the satellite positioning position determined by the satellite positioning method, the unmanned equipment is fused and positioned. By determining the confidence of the current satellite positioning result of the unmanned equipment, and positioning based on the confidence of the result, the accuracy of the positioning of the unmanned equipment is improved.
附图说明Description of drawings
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:The drawings described herein are used to provide further understanding of the present application and constitute a part of the present application. The schematic embodiments and descriptions of the present application are used to explain the present application and do not constitute an improper limitation of the present application. In the attached image:
图1为本公开实施例提供的一种无人驾驶设备的定位方法的流程示意图;1 is a schematic flowchart of a method for locating an unmanned device according to an embodiment of the present disclosure;
图2A~图2B为本公开实施例提供的确定目标区域中未遮挡卫星信号区域占比的示意图;2A-2B are schematic diagrams of determining the proportion of unobstructed satellite signal areas in a target area according to an embodiment of the present disclosure;
图3为本公开实施例提供的一种基于增量偏差更新结果置信度的示意图;3 is a schematic diagram of updating result confidence based on incremental deviation according to an embodiment of the present disclosure;
图4为本公开实施例提供的一种无人驾驶设备的定位装置的结构示意图;FIG. 4 is a schematic structural diagram of a positioning device for an unmanned device according to an embodiment of the present disclosure;
图5为本公开实施例提供的实现无人驾驶设备的定位方法的无人驾驶设备示意图。FIG. 5 is a schematic diagram of an unmanned device for implementing a method for positioning an unmanned device according to an embodiment of the present disclosure.
具体实施方式Detailed ways
为使本公开的目的、技术方案和优点更加清楚,下面将结合本公开具体实施例及相应的附图对本申请技术方案进行清楚、完整地描述。显然,所描述的实施例仅是本申请一部分实施例,而不是全部的实施例。基于说明书中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。In order to make the purpose, technical solutions and advantages of the present disclosure clearer, the technical solutions of the present application will be described clearly and completely below with reference to the specific embodiments of the present disclosure and the corresponding drawings. Obviously, the described embodiments are only a part of the embodiments of the present application, but not all of the embodiments. Based on the embodiments in the description, all other embodiments obtained by those of ordinary skill in the art without creative work fall within the scope of protection of the present application.
本公开提供一种无人驾驶设备的定位方法,如图1所示。The present disclosure provides a positioning method for an unmanned device, as shown in FIG. 1 .
图1为本公开实施例提供的一种无人驾驶设备的定位方法的流程示意图,具体可包括以下步骤:1 is a schematic flowchart of a method for locating an unmanned device according to an embodiment of the present disclosure, which may specifically include the following steps:
S100:确定无人驾驶设备当前所处目标区域。S100: Determine the target area where the unmanned device is currently located.
在本公开一种或多种实施例中,该无人驾驶设备可以是无人车、无人机以及机器人等设备。通过本公开提供的定位方法,可以实时确定无人驾驶设备在行驶过程中的位置。In one or more embodiments of the present disclosure, the unmanned device may be a device such as an unmanned vehicle, a drone, and a robot. With the positioning method provided by the present disclosure, the position of the unmanned device during the driving process can be determined in real time.
具体的,在对无人驾驶设备进行定位时,可先粗略确定该无人驾驶设备的当前位置。之后,根据该无人驾驶设备的当前位置,以及预先划分的多个区域分别对应的位置范围,确定该无人驾驶设备当前落入的目标区域,即为该无人驾驶设备当前所处目标区域。其中,预先划分的多个区域可以按照单位范围进行划分,如,将地面区域划分为若干边长 为5米的正方形。Specifically, when positioning the unmanned device, the current position of the unmanned device may be roughly determined first. After that, according to the current position of the unmanned device and the corresponding position ranges of the pre-divided areas, determine the target area where the unmanned device currently falls, that is, the target area where the unmanned device is currently located. . Among them, the pre-divided areas can be divided according to the unit range, for example, the ground area is divided into several squares with a side length of 5 meters.
需要说明的是,上述针对该无人驾驶设备粗略确定的当前位置并不十分准确。可以根据该无人驾驶设备历史上最近一次的定位结果,粗略确定该无人驾驶设备的当前位置。当然,也可采用任意一种现有的定位方法,来粗略确定该无人驾驶设备的位置,如,基站定位、卫星定位以及激光雷达定位等,本公开对此不作限制,具体可根据需要设置。It should be noted that the above rough determination of the current position of the unmanned device is not very accurate. The current position of the unmanned device can be roughly determined according to the latest positioning result of the unmanned device in the history. Of course, any existing positioning method can also be used to roughly determine the position of the unmanned device, such as base station positioning, satellite positioning, and lidar positioning, etc., which are not limited in this disclosure, and can be set as required. .
S102:根据所述目标区域中未遮挡卫星信号的区域占比,以及预先拟合的定位偏差函数,确定所述无人驾驶设备当前进行卫星定位的结果置信度。S102: Determine the confidence level of the current satellite positioning result performed by the unmanned device according to the proportion of the area in the target area that does not block satellite signals and the pre-fitted positioning deviation function.
在本公开一种或多种实施例中,当粗略确定出无人驾驶设备所处的目标区域后,可根据该目标区域对卫星信号的遮挡情况,确定该无人驾驶设备通过卫星定位是否准确。In one or more embodiments of the present disclosure, after roughly determining the target area where the unmanned device is located, it can be determined whether the satellite positioning of the unmanned device is accurate according to the occlusion of the satellite signal by the target area. .
具体的,当确定出该无人驾驶设备所处的目标区域后,可从预先存储的多个区域对应的未遮挡卫星信号的区域占比中,确定该目标区域中未遮挡卫星信号的区域占比。之后,将该目标区域中未遮挡卫星信号的区域占比,输入预先拟合的定位偏差函数中,得到该无人驾驶设备在该目标区域内进行卫星定位所产生的定位偏差。最后,根据该无人驾驶设备在该目标区域内进行卫星定位所产生的定位偏差,确定该无人驾驶设备当前进行卫星定位的结果置信度。Specifically, after the target area where the unmanned device is located is determined, the area proportion of the unobstructed satellite signals in the target area can be determined from the pre-stored area proportions of the unobstructed satellite signals corresponding to the multiple areas. Compare. After that, the proportion of the area in the target area that does not block the satellite signal is input into the pre-fitted positioning deviation function to obtain the positioning deviation generated by the satellite positioning of the unmanned vehicle in the target area. Finally, according to the positioning deviation generated by the satellite positioning performed by the unmanned equipment in the target area, the confidence level of the current satellite positioning result of the unmanned equipment is determined.
其中,预先划分的多个区域是指按照单位范围划分得到的多个栅格,未遮挡卫星信号的区域,是指无人驾驶设备可直接接收到卫星信号的区域范围,也就是说,卫星信号不被任何障碍物遮挡而直接被该无人驾驶设备接收。并且,该定位偏差与该结果置信度呈负相关,定位偏差越大,结果置信度越小,表示当前进行卫星定位的定位结果不准确。Among them, the pre-divided multiple areas refer to multiple grids divided according to the unit range, and the area that does not block the satellite signal refers to the area where the unmanned device can directly receive the satellite signal, that is, the satellite signal It is directly received by the unmanned device without being blocked by any obstacle. In addition, the positioning deviation is negatively correlated with the confidence of the result. The larger the positioning deviation, the smaller the confidence of the result, indicating that the positioning result of the current satellite positioning is inaccurate.
在一些实施例中,在确定该无人驾驶设备当前进行卫星定位的结果置信度时,可将基于预先拟合的定位偏差函数输出的定位偏差,作为第一定位偏差。再结合历史上在该目标区域通过卫星定位确定的第二定位偏差,以及该第一定位偏差,确定该无人驾驶设备在该目标区域进行卫星定位的定位偏差,例如,该无人驾驶设备在该目标区域进行卫星定位的定位偏差可以为第一定位偏差和第二定位偏差的平均值。根据该无人驾驶设备在该目标区域进行卫星定位的定位偏差,确定该无人驾驶设备当前进行卫星定位的结果置信度,例如,该无人驾驶设备在该目标区域进行卫星定位的定位偏差与结果置信度为负相关,定位偏差越大,结果置信度越低。In some embodiments, when determining the confidence of the current satellite positioning result performed by the unmanned device, the positioning deviation output based on the pre-fitted positioning deviation function may be used as the first positioning deviation. Combined with the second positioning deviation determined by satellite positioning in the target area in the history, and the first positioning deviation, determine the positioning deviation of the satellite positioning of the unmanned equipment in the target area, for example, the unmanned equipment is in The positioning deviation of the satellite positioning of the target area may be an average value of the first positioning deviation and the second positioning deviation. According to the positioning deviation of the satellite positioning performed by the unmanned device in the target area, the confidence level of the current satellite positioning result of the unmanned device is determined. For example, the positioning deviation of the satellite positioning performed by the unmanned device in the target area is the same as The confidence of the results is negatively correlated, and the greater the positioning deviation, the lower the confidence of the results.
S104:根据接收到的多个卫星的卫星信号,确定所述无人驾驶设备当前的卫星定位位置。S104: Determine the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites.
S106:根据所述无人驾驶设备当前的卫星定位位置,以及当前进行卫星定位的结果置信度,对所述无人驾驶设备进行融合定位,确定所述无人驾驶设备的融合定位位置。S106: According to the current satellite positioning position of the unmanned device and the confidence level of the current satellite positioning result, perform fusion positioning on the unmanned device, and determine the fusion positioning position of the unmanned device.
本公开提供的定位方法,可基于该无人驾驶设备当前进行卫星定位的结果置信度,确定该无人驾驶设备的精准位置。The positioning method provided by the present disclosure can determine the precise position of the unmanned device based on the confidence of the current satellite positioning result of the unmanned device.
具体的,该无人驾驶设备可通过自身配置的GPS传感器,接收多个卫星的卫星信号,并基于接收到的多个卫星的卫星信号,通过卫星定位的方式,确定该无人驾驶设备当前的卫星定位位置。Specifically, the unmanned device can receive satellite signals of multiple satellites through the GPS sensor configured by itself, and determine the current status of the unmanned device by means of satellite positioning based on the received satellite signals of multiple satellites. Satellite positioning location.
之后,可判断该无人驾驶设备当前进行卫星定位的结果置信度是否大于预设阈值。当确定该结果置信度大于预设阈值时,表明当前通过卫星定位的结果可信,可确定该无人驾驶设备当前的卫星定位位置准确。于是,可根据卫星定位方式确定出的卫星定位位置,以及其它定位方式,进行融合定位,确定该无人驾驶设备的融合定位位置。其中,该融合定位位置即为无人驾驶设备较为精准的位置。Afterwards, it can be determined whether the confidence level of the result of the current satellite positioning performed by the unmanned device is greater than a preset threshold. When it is determined that the confidence level of the result is greater than the preset threshold, it indicates that the result of the current satellite positioning is credible, and it can be determined that the current satellite positioning position of the unmanned device is accurate. Therefore, the fusion positioning can be performed according to the satellite positioning position determined by the satellite positioning method and other positioning methods, and the fusion positioning position of the unmanned device can be determined. Among them, the fusion positioning position is the more accurate position of the unmanned device.
当确定该结果置信度小于预设阈值时,表明当前通过卫星定位的结果不可信,可确定该无人驾驶设备当前的卫星定位位置不准确。于是,可采用其它定位方式,对该无人驾驶设备进行定位,确定该无人驾驶设备的融合定位位置。其中,该预设阈值可根据需要设置,如,设置为0.5。该其它定位方式可以是IMU定位、激光雷达定位以及视觉定位中的一种或多种,本公开对此不做限制。When it is determined that the confidence level of the result is less than the preset threshold, it indicates that the current satellite positioning result is unreliable, and it can be determined that the current satellite positioning position of the unmanned device is inaccurate. Therefore, other positioning methods can be used to locate the unmanned device to determine the fusion positioning position of the unmanned device. Wherein, the preset threshold can be set as required, for example, set to 0.5. The other positioning manner may be one or more of IMU positioning, lidar positioning, and visual positioning, which is not limited in the present disclosure.
由于城市中建筑物分布较为密集,在传输卫星信号时容易产生多路径效应,导致卫星定位不准确,进而使得无人车定位的误差较大。基于图1所示的无人驾驶设备的定位方法,本公开实施例预先基于历史上多个区域中未遮挡卫星信号的区域占比以及在多个区域内的定位偏差拟合得到定位偏差函数。在对无人驾驶设备进行定位时,可根据该无人驾驶设备当前所处目标区域中未遮挡卫星信号的区域占比,以及该预先拟合的定位偏差函数,确定当前进行卫星定位的结果置信度。并根据该结果置信度以及通过卫星定位方式确定的卫星定位位置,对该无人驾驶设备进行融合定位。通过确定无人驾驶设备当前进行卫星定位的结果置信度,并基于该结果置信度进行定位,提高了无人驾驶设备定位的准确度。Due to the dense distribution of buildings in cities, multi-path effects are prone to occur when transmitting satellite signals, resulting in inaccurate satellite positioning, which in turn makes unmanned vehicle positioning errors larger. Based on the positioning method of the unmanned vehicle shown in FIG. 1 , the embodiment of the present disclosure obtains the positioning deviation function in advance based on the proportion of the regions in which the satellite signals are not blocked in the history and the positioning deviation in the multiple regions. When positioning the unmanned device, the confidence of the current satellite positioning result can be determined according to the proportion of the unobstructed satellite signal in the target area where the unmanned device is currently located, and the pre-fitted positioning deviation function. Spend. And according to the confidence of the result and the satellite positioning position determined by the satellite positioning method, the unmanned equipment is fused and positioned. By determining the confidence of the current satellite positioning result of the unmanned device, and performing positioning based on the confidence of the result, the accuracy of the positioning of the unmanned device is improved.
在本公开步骤S102中,在确定多个区域中未遮挡信号的区域占比时,具体的,针对预先划分多个区域中的每个区域,可先确定该区域对应的一个或多个障碍物的障碍物信息,即,该区域周围或者该区域内部的一个或多个障碍物。之后,根据该区域对应的 一个或多个障碍物的障碍物信息,如,位置信息以及高度信息等,确定在该区域中心点位置接收卫星信号未被障碍物遮挡的角度范围。最后,根据在该区域中心点位置接收卫星信号未被障碍物遮挡的角度范围,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比。In step S102 of the present disclosure, when determining the area ratio of the unobstructed signals in the multiple areas, specifically, for each area in the pre-divided multiple areas, one or more obstacles corresponding to the area may be determined first. , that is, one or more obstacles around the area or inside the area. Then, according to the obstacle information of one or more obstacles corresponding to the area, such as position information and altitude information, etc., determine the angular range in which the satellite signal is received at the center point of the area without being blocked by the obstacle. Finally, according to the angular range of the received satellite signal at the center point of the area that is not blocked by obstacles, the proportion of the area in which the received satellite signal is not blocked by obstacles is determined.
图2A~2B为本公开实施例提供的确定目标区域中未遮挡卫星信号区域占比的示意图。在图2A中,对于无人驾驶设备当前所处的目标区域,该目标区域两侧存在高度不同的建筑物,该建筑物即为遮挡该目标区域内卫星信号的障碍物。2A-2B are schematic diagrams of determining the proportion of unobstructed satellite signal areas in a target area according to an embodiment of the present disclosure. In FIG. 2A , for the target area where the unmanned device is currently located, there are buildings with different heights on both sides of the target area, and the buildings are obstacles that block satellite signals in the target area.
一般的,理想的信号接收区域为前后左右180度范围内均不存在遮挡卫星信号的障碍物。但在实际道路中,道路延伸方向上通常不存在遮挡卫星信号的障碍物,因此在道路延伸方向上-90°~90°范围内接收的卫星信号均不被障碍物遮挡。而由于道路两侧障碍物的存在,在垂直道路方向上存在部分角度被遮挡,如图2A所示,在该目标区域的-90°~-α°以及β°~90°的角度范围内由于障碍物遮挡无法接收卫星信号。因此可根据该目标区域对应的障碍物的位置以及高度等障碍物信息,确定在垂直道路方向上该目标区域接收的卫星信号未被障碍物遮挡的角度范围为-α°~β°。Generally, the ideal signal receiving area is that there are no obstacles blocking the satellite signal within a range of 180 degrees in the front, rear, left and right. However, in actual roads, there are usually no obstacles that block satellite signals in the direction of road extension, so satellite signals received in the range of -90° to 90° in the direction of road extension are not blocked by obstacles. However, due to the existence of obstacles on both sides of the road, some angles in the direction perpendicular to the road are blocked. As shown in Figure 2A, within the range of -90°~-α° and β°~90° of the target area, due to Obstacles block and cannot receive satellite signals. Therefore, according to the obstacle information such as the position and height of the obstacle corresponding to the target area, it can be determined that the angle range of the satellite signal received by the target area not blocked by the obstacle in the vertical road direction is -α°~β°.
在图2B中,分别以“道路延伸方向”和“垂直道路方向”两个不同方向上接收卫星信号的角度范围为坐标轴,建立二维极坐标系。之后,分别根据该目标区域分别在道路延伸方向接收卫星信号未被障碍物遮挡的角度范围-90°~90°,以及在垂直道路方向接收卫星信号未被障碍物遮挡的角度范围-α°~β°,确定在该目标区域内未遮挡卫星信号的区域以及区域占比。其中,空白区域表示未遮挡卫星信号的区域,灰色填充区域表示障碍物遮挡卫星信号的区域。In FIG. 2B , a two-dimensional polar coordinate system is established with the angular ranges of receiving satellite signals in two different directions, "road extension direction" and "vertical road direction" as coordinate axes. After that, according to the target area, the angular range -90°~90° when the satellite signal is not blocked by obstacles in the direction of road extension, and the angular range -α°~90° when the satellite signal is received in the vertical direction of the road and not blocked by obstacles β°, to determine the area that does not block the satellite signal and the proportion of the area in the target area. Among them, the blank area represents the area where the satellite signal is not blocked, and the gray filled area represents the area where the obstacle blocks the satellite signal.
另外,本公开中预先拟合的定位偏差函数,可基于历史上多个区域中未遮挡卫星信号的区域占比以及在多个区域内的定位偏差拟合得到。在拟合定位偏差函数时,可先获取历史上在预先划分的多个区域内通过卫星定位产生的定位偏差。之后,针对预先划分的多个区域中的每个区域,可根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比。最后,根据多个区域内未遮挡卫星信号的区域占比,以及在多个区域内产生的定位偏差,拟合得到定位偏差函数。其中,确定多个区域内接收卫星信号未被障碍物遮挡的区域占比的具体方式在上述已经进行了详细说明,本公开对此不再赘述。In addition, the pre-fitted positioning deviation function in the present disclosure can be obtained by fitting based on the proportion of the regions in which the satellite signals are not blocked in the history and the positioning deviation in the multiple regions. When fitting the positioning deviation function, historical positioning deviations generated by satellite positioning in a plurality of pre-divided regions can be obtained first. Afterwards, for each of the pre-divided areas, the proportion of the area in which the satellite signal is received and not blocked by the obstacle may be determined according to the obstacle information of one or more obstacles corresponding to the area. Finally, according to the proportion of unobstructed satellite signals in multiple regions, and the positioning deviation generated in multiple regions, the positioning deviation function is obtained by fitting. The specific manner of determining the proportion of the areas in which the received satellite signals are not blocked by obstacles has been described in detail above, and will not be repeated in the present disclosure.
此外,由于无人驾驶设备对定位的实时性要求较高,而多个区域中未遮挡卫星信号的区域占比,需要根据高精地图中多个区域中每个区域对应的一个或多个障碍物信息进 行确定,计算量较大。因此在本公开中,可预先离线确定无人驾驶设备待行驶的多个区域中未遮挡卫星信号的区域占比,以及预先拟合定位偏差函数。当需要定位时,可直接从预先存储的多个区域对应的未遮挡卫星信号的区域占比中,确定该无人驾驶设备当前所处目标区域中未遮挡卫星信号的区域占比,并根据该目标区域中未遮挡卫星信号的区域占比,以及预先拟合的定位偏差函数,确定在该目标区域内进行卫星定位的定位偏差。减少了在定位时所需的计算量,提高了定位的实时性。In addition, due to the high requirements for real-time positioning of unmanned devices, and the proportion of areas that do not block satellite signals in multiple areas, one or more obstacles corresponding to each area in the multiple areas in the high-precision map need to be determined. The amount of calculation is large. Therefore, in the present disclosure, the proportion of the areas that do not block satellite signals in the multiple areas to be driven by the unmanned device can be pre-determined offline, and the positioning deviation function can be pre-fitted. When positioning is required, the proportion of the unobstructed satellite signal area in the target area where the unmanned vehicle is currently located can be directly determined from the pre-stored area proportions of the unobstructed satellite signals corresponding to the multiple areas, and based on the The proportion of the unobstructed satellite signal area in the target area, and the pre-fitted positioning deviation function, determine the positioning deviation of satellite positioning in the target area. The calculation amount required for positioning is reduced, and the real-time performance of positioning is improved.
在本公开步骤S106中,当通过融合定位方式精准确定出该无人驾驶设备的位置后,可根据该精准的融合定位位置,对通过卫星定位方式得到的卫星定位位置进行修正。具体的,可根据该无人驾驶设备的融合定位位置、卫星定位位置以及在该目标区域进行卫星定位的定位偏差,确定在该目标区域内进行卫星定位的增量偏差。之后,根据在该目标区域内进行卫星定位的增量偏差,更新历史上在该目标区域内进行卫星定位的第二定位偏差,以根据该第二定位偏差,修正在该目标区域内进行卫星定位产生的定位偏差。In step S106 of the present disclosure, after the position of the unmanned device is accurately determined by the fusion positioning method, the satellite positioning position obtained by the satellite positioning method can be corrected according to the precise fusion positioning position. Specifically, the incremental deviation of satellite positioning in the target area can be determined according to the fusion positioning position of the unmanned device, the satellite positioning position, and the positioning deviation of satellite positioning in the target area. Then, according to the incremental deviation of satellite positioning in the target area, update the second positioning deviation of satellite positioning in the target area in the history, so as to correct the satellite positioning in the target area according to the second positioning deviation The resulting positioning error.
综上所述,如图3所示,该无人驾驶设备可基于接收到的卫星信号,确定自身的卫星定位位置,并根据当前的卫星定位位置以及进行卫星定位的结果置信度,对该无人驾驶设备进行融合定位,确定融合定位位置。其中,该卫星定位的结果置信度可基于拟合的定位偏差函数输出的第一定位偏差,以及历史上在该目标区域确定的第二定位偏差确定。之后,可根据自身的融合定位位置以及卫星定位位置,确定在该目标区域内进行卫星定位产生的增量偏差,以根据该增量偏差,对该第二定位偏差进行更新,进而更新在目标区域中进行卫星定位的结果置信度。通过不断的迭代更新,使得该目标区域的结果置信度更准确。To sum up, as shown in Figure 3, the unmanned device can determine its own satellite positioning position based on the received satellite signals, and based on the current satellite positioning position and the confidence of the satellite positioning result, The human-driving device performs fusion positioning to determine the fusion positioning position. The confidence of the satellite positioning result may be determined based on the first positioning deviation output by the fitted positioning deviation function and the second positioning deviation determined in the target area in the history. After that, the incremental deviation generated by satellite positioning in the target area can be determined according to its own fusion positioning position and satellite positioning position, so as to update the second positioning deviation according to the incremental deviation, and then update the second positioning deviation in the target area. Confidence in the result of satellite positioning. Through continuous iterative update, the result confidence of the target area is made more accurate.
在一些实施例中,为了更加准确的对卫星定位的偏差进行修正,也可获取历史上若干次在该目标区域中进行卫星定位所产生的增量偏差,并根据若干次产生的增量偏差的平均值,更新历史上在该目标区域内进行卫星定位的第二定位偏差。In some embodiments, in order to more accurately correct the deviation of satellite positioning, incremental deviations generated by satellite positioning in the target area for several times in the history may also be obtained, and according to the difference of the incremental deviations generated several times Average, update the second positioning deviation of satellite positioning in the target area in history.
在一些实施例中,可以基于无人驾驶设备当前所处目标区域,估算卫星定位在该区域的水平位置偏差(也被称为定位偏差)(单位米)。此估算的偏差可用于最终的融合定位算法的计算。下面实施例具体示出了本公开实施例提供的无人驾驶设备的定位方法,包括步骤一至步骤三:In some embodiments, based on the target area where the unmanned device is currently located, the horizontal position deviation (also referred to as positioning deviation) (unit meters) of the satellite positioning in the area may be estimated. This estimated bias can be used in the calculation of the final fused localization algorithm. The following embodiments specifically illustrate the positioning method for an unmanned vehicle provided by the embodiments of the present disclosure, including steps 1 to 3:
步骤一:获得按天空遮挡情况估算表示卫星定位位置误差的拟合函数S。Step 1: Obtain a fitting function S that is estimated to represent the satellite positioning position error according to the occlusion of the sky.
在上面的实施例中,拟合函数S为定位偏差函数。在获取拟合函数S时,采集多个 样本数据,每个样本数据中包含卫星定位位置(x,y),真实位置(x’,y’),未遮挡卫星信号区域占比p。真实位置可为融合定位位置。针对每个样本数据,对该样本数据进一步处理,得到横坐标为p,纵坐标为卫星水平定位偏差值d的样本点。具体的,p的值域可以为[0.0,1.0],卫星定位水平位置偏差d计算公式可以为d=sqrt((x-x’)^2+(y-y’)^2)。对多个样本点进行曲线拟合,获得曲线函数d=S(p)。输入未遮挡卫星信号区域占比p,通过该函数可获得对应估算的水平位置偏差d。In the above embodiment, the fitting function S is a positioning deviation function. When obtaining the fitting function S, collect multiple sample data, each sample data contains satellite positioning position (x, y), real position (x', y'), and the proportion of unobstructed satellite signal area p. The true location may be a fused location location. For each sample data, the sample data is further processed to obtain a sample point whose abscissa is p and the ordinate is the satellite horizontal positioning deviation value d. Specifically, the value range of p may be [0.0, 1.0], and the calculation formula of the satellite positioning horizontal position deviation d may be d=sqrt((x-x')^2+(y-y')^2). Curve fitting is performed on multiple sample points to obtain a curve function d=S(p). Enter the proportion p of the unobstructed satellite signal area, and the corresponding estimated horizontal position deviation d can be obtained through this function.
步骤二:在初次绘制地图时,记录卫星定位水平位置偏差d。Step 2: When drawing a map for the first time, record the horizontal position deviation d of satellite positioning.
对地图进行水平方向栅格化处理,得到多个栅格。对每个栅格Ci(i为栅格编号),计算在这个栅格位置上未遮挡卫星信号区域占比pi。按函数S获得该栅格的卫星位置误差估算值(定位偏差)di=S(pi)。将估算出来的卫星位置误差di记录在地图栅格Ci里。The map is rasterized in the horizontal direction to obtain multiple grids. For each grid Ci (i is the grid number), calculate the proportion pi of the unobstructed satellite signal area at this grid position. The satellite position error estimate (positioning deviation) di=S(pi) for the grid is obtained by function S. Record the estimated satellite position error di in the map grid Ci.
步骤三:在使用地图的实际运行中不断修正地图里的卫星位置误差估算值。Step 3: Constantly correct the estimated satellite position error in the map during the actual operation of the map.
通过实际运行的数据,当无人驾驶设备处在栅格Ci时,观测到的卫星定位结果(xi,yi)和当时车辆融合定位位置(xi”,yi”),并计算卫星定位的水平位置增量偏差di’。具体的,di’的计算方法可以为di’=sqrt((xi-xi”)^2+(yi-yi”)^2)。由于无人驾驶设备可能多次行驶到栅格Ci,所以可以基于多个di’计算卫星定位的水平增量偏差平均值average。Through the actual operation data, when the unmanned equipment is in the grid Ci, the observed satellite positioning results (xi,yi) and the vehicle fusion positioning position (xi",yi") at that time, and calculate the horizontal position of the satellite positioning Incremental deviation di'. Specifically, the calculation method of di' may be di'=sqrt((xi-xi")^2+(yi-yi")^2). Since the unmanned device may travel to the grid Ci multiple times, the average value of the horizontal incremental deviation of the satellite positioning can be calculated based on multiple di'.
对栅格Ci记录的卫星位置误差估算值进行修正。Ci里记录的原有卫星水平位置误差估算值为di(old),当得到多次平均卫星定位水平位置误差average,可以按一个固定修正量系数α对di(old)进行修正,修正量为α*(average-di(old))。该系数α控制修正的速度,取值为0.0~1.0(按工程经验建议值为0.1,可以使修正量平缓趋近average,防止偶然因素导致di’值剧烈波动)。修正后的新卫星水平位置误差估算值为di(new)=di(old)+α*(average-di(old))。将新值di(new)记录进地图栅格Ci,替换原有值di(old)。Corrections are made to the satellite position error estimates recorded in raster Ci. The estimated value of the original satellite horizontal position error recorded in Ci is di(old). When the average satellite positioning horizontal position error average is obtained, di(old) can be corrected according to a fixed correction coefficient α, and the correction amount is α *(average-di(old)). The coefficient α controls the speed of correction, and its value is 0.0 to 1.0 (the recommended value is 0.1 according to engineering experience, which can make the correction amount gradually approach the average, and prevent the di' value from fluctuating violently due to accidental factors). The revised estimate of the horizontal position error of the new satellite is di(new)=di(old)+α*(average−di(old)). Record the new value di(new) into the map grid Ci, replacing the original value di(old).
综合步骤一至步骤三,可使无人驾驶设备行驶时不仅仅能获得卫星定位接收机估算的位置偏差,也能通过无人驾驶设备位置直接查图获得供融合算法使用的卫星定位偏差。Combining steps 1 to 3, the unmanned equipment can not only obtain the position deviation estimated by the satellite positioning receiver when driving, but also obtain the satellite positioning deviation for the fusion algorithm by directly checking the position of the unmanned equipment.
本公开所示的定位方法具体可用于无人配送过程中,当应用该定位方法执行无人配送任务时,该无人驾驶设备可通过本公开中的定位方法,实时确定自身位置,以根据自身位置进行配送路径规划,并按照规划好的路径执行该配送任务。The positioning method shown in this disclosure can be specifically used in the process of unmanned distribution. When the positioning method is applied to perform an unmanned distribution task, the unmanned device can determine its own position in real time through the positioning method in this disclosure, so as to determine its own position according to its own The distribution path is planned according to the location, and the distribution task is executed according to the planned path.
基于图1所示的无人驾驶设备的定位方法,本公开实施例还对应提供一种无人驾驶设备的定位装置的结构示意图,如图4所示。Based on the positioning method for an unmanned device shown in FIG. 1 , an embodiment of the present disclosure also provides a schematic structural diagram of a positioning device for an unmanned device, as shown in FIG. 4 .
图4为本公开实施例提供的一种无人驾驶设备的定位装置的结构示意图,包括:FIG. 4 is a schematic structural diagram of a positioning device for an unmanned device provided by an embodiment of the present disclosure, including:
区域确定模块200,确定无人驾驶设备当前所处目标区域;The area determination module 200 determines the target area where the unmanned device is currently located;
置信度确定模块202,根据所述目标区域中未遮挡卫星信号的区域占比,以及预先拟合的定位偏差函数,确定所述无人驾驶设备当前进行卫星定位的结果置信度,其中,所述定位偏差函数根据历史上多个区域中未遮挡卫星信号的区域占比以及在多个区域内的定位偏差拟合得到;The confidence level determination module 202 determines the confidence level of the current satellite positioning result performed by the unmanned device according to the proportion of the unobstructed satellite signal in the target area and the pre-fitted positioning deviation function, wherein the The positioning deviation function is fitted according to the proportion of unobstructed satellite signals in multiple regions in history and the positioning deviation in multiple regions;
卫星定位模块204,根据接收到的多个卫星的卫星信号,确定所述无人驾驶设备当前的卫星定位位置;The satellite positioning module 204 determines the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites;
融合定位模块206,根据所述无人驾驶设备当前的卫星定位位置,以及当前进行卫星定位的结果置信度,对所述无人驾驶设备进行融合定位,确定所述无人驾驶设备的融合定位位置。The fusion positioning module 206, according to the current satellite positioning position of the unmanned equipment and the confidence of the current satellite positioning result, perform fusion positioning on the unmanned equipment, and determine the fusion positioning position of the unmanned equipment .
可选地,所述置信度确定模块202具体用于,根据所述定位偏差函数输出的第一定位偏差,以及历史上在所述目标区域确定的第二定位偏差,确定所述无人驾驶设备在所述目标区域进行卫星定位的定位偏差,根据所述无人驾驶设备在所述目标区域进行卫星定位的定位偏差,确定所述无人驾驶设备当前进行卫星定位的结果置信度。Optionally, the confidence level determination module 202 is specifically configured to determine the unmanned vehicle according to the first positioning deviation output by the positioning deviation function and the second positioning deviation historically determined in the target area. The positioning deviation of the satellite positioning performed in the target area is determined according to the positioning deviation of the satellite positioning performed by the unmanned device in the target area to determine the confidence level of the current satellite positioning result performed by the unmanned device.
可选地,所述融合定位模块206具体用于,判断所述结果置信度是否大于预设阈值,若是,根据所述卫星定位位置以及其它定位方式,进行融合定位,确定所述无人驾驶设备的融合定位位置,若否,根据其它定位方式,确定所述无人驾驶设备的融合定位位置。Optionally, the fusion positioning module 206 is specifically configured to determine whether the confidence of the result is greater than a preset threshold, and if so, perform fusion positioning according to the satellite positioning position and other positioning methods to determine the unmanned vehicle. If not, determine the fusion positioning position of the unmanned vehicle according to other positioning methods.
可选地,所述融合定位模块206还用于,根据所述无人驾驶设备的融合定位位置以及所述无人驾驶设备的卫星定位位置,确定在所述目标区域内进行卫星定位的增量偏差,根据在所述目标区域内进行卫星定位的增量偏差,更新历史上在所述目标区域内进行卫星定位的第二定位偏差。Optionally, the fusion positioning module 206 is further configured to, according to the fusion positioning position of the unmanned equipment and the satellite positioning position of the unmanned equipment, determine the increment of satellite positioning in the target area. The deviation, according to the incremental deviation of the satellite positioning in the target area, update the second positioning deviation of the satellite positioning in the target area in the history.
可选地,所述融合定位模块206还用于,根据历史上若干次在所述目标区域内进行卫星定位的增量偏差的平均值,更新历史上在所述目标区域内进行卫星定位的第二定位偏差。Optionally, the fusion positioning module 206 is further configured to, according to the average value of the incremental deviations of satellite positioning performed in the target area several times in the history, update the number of satellite positioning performed in the history in the target area. Two positioning deviation.
可选地,所述无人驾驶设备的定位装置还包含离线拟合模块208,所述离线拟合模块208具体用于,获取历史上在预先划分的多个区域内通过卫星定位产生的定位偏差,针对预先划分的多个区域的每个区域,根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比,根据多个区域内未遮挡卫星信号的区域占比,以及在多个区域内产生的定位偏差,拟合得到定位偏差函数。Optionally, the positioning device of the unmanned equipment further includes an offline fitting module 208, and the offline fitting module 208 is specifically configured to acquire the positioning deviations generated by satellite positioning in the pre-divided regions in the history. , for each area of the pre-divided multiple areas, according to the obstacle information of one or more obstacles corresponding to the area, determine the proportion of the area receiving satellite signals that are not blocked by obstacles in the area. The proportion of unobstructed satellite signals in the region and the positioning deviation generated in multiple regions are fitted to obtain the positioning deviation function.
可选地,所述离线拟合模块208具体用于,根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域中心点位置接收卫星信号未被障碍物遮挡的角度范围,根据在该区域中心点位置接收卫星信号未被障碍物遮挡的角度范围,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比。Optionally, the offline fitting module 208 is specifically configured to, according to the obstacle information of one or more obstacles corresponding to the area, determine the angular range in which the satellite signal is received at the center point of the area without being blocked by the obstacle, According to the angular range of receiving satellite signals at the center point of the area that is not blocked by obstacles, determine the proportion of the area where satellite signals are received and not blocked by obstacles in the area.
本公开实施例还提供了一种计算机可读存储介质,该存储介质存储有计算机程序,计算机程序可用于执行上述图1提供的无人驾驶设备的定位方法。Embodiments of the present disclosure further provide a computer-readable storage medium, where a computer program is stored in the storage medium, and the computer program can be used to execute the method for positioning an unmanned vehicle provided in FIG. 1 .
基于图1所示的无人驾驶设备的定位方法,本公开实施例还提出了图5所示的无人驾驶设备的示意结构图。如图5,在硬件层面,该无人驾驶设备包括处理器、内部总线、网络接口、内存以及非易失性存储器,当然还可能包括其他业务所需要的硬件。处理器从非易失性存储器中读取对应的计算机程序到内存中然后运行,以实现上述图1所示的无人驾驶设备的定位方法。Based on the positioning method of the unmanned device shown in FIG. 1 , an embodiment of the present disclosure also proposes a schematic structural diagram of the unmanned device shown in FIG. 5 . As shown in Figure 5, at the hardware level, the driverless device includes a processor, an internal bus, a network interface, a memory, and a non-volatile memory, and of course, it may also include hardware required by other services. The processor reads the corresponding computer program from the non-volatile memory into the memory and runs it, so as to realize the positioning method of the unmanned vehicle shown in FIG. 1 above.
当然,除了软件实现方式之外,本公开并不排除其他实现方式,比如逻辑器件抑或软硬件结合的方式等等,也就是说以下处理流程的执行主体并不限定于各个逻辑单元,也可以是硬件或逻辑器件。Of course, in addition to software implementation, the present disclosure does not exclude other implementations, such as logic devices or a combination of software and hardware, etc., that is to say, the execution subject of the following processing flow is not limited to each logic unit, but can also be hardware or logic device.
在20世纪90年代,对于一个技术的改进可以很明显地区分是硬件上的改进(例如,对二极管、晶体管、开关等电路结构的改进)还是软件上的改进(对于方法流程的改进)。然而,随着技术的发展,当今的很多方法流程的改进已经可以视为硬件电路结构的直接改进。设计人员几乎都通过将改进的方法流程编程到硬件电路中来得到相应的硬件电路结构。因此,不能说一个方法流程的改进就不能用硬件实体模块来实现。例如,可编程逻辑器件(Programmable Logic Device,PLD)(例如现场可编程门阵列(Field Programmable Gate Array,FPGA))就是这样一种集成电路,其逻辑功能由用户对器件编程来确定。由设计人员自行编程来把一个数字系统“集成”在一片PLD上,而不需要请芯片制造厂商来设计和生成专用的集成电路芯片。而且,如今,取代手工地生成集成电路芯片,这种编程也多半改用“逻辑编译器(logic compiler)”软件来实现,它与程序开发撰写时所用的软件编译器相类似,而要编译之前的原始代码也得用特定的编程语言来撰写,此称之为硬件描述语言(Hardware Description Language,HDL),而HDL也并非仅有一种,而是有许多种,如ABEL(Advanced Boolean Expression Language)、AHDL(Altera Hardware Description Language)、Confluence、CUPL(Cornell University Programming Language)、HDCal、JHDL(Java Hardware Description Language)、Lava、Lola、MyHDL、PALASM、RHDL(Ruby Hardware Description Language)等,目前最 普遍使用的是VHDL(Very-High-Speed Integrated Circuit Hardware Description Language)与Verilog。本领域技术人员也应该清楚,只需要将方法流程用上述几种硬件描述语言稍作逻辑编程并编程到集成电路中,就可以很容易得到实现该逻辑方法流程的硬件电路。In the 1990s, improvements in a technology could be clearly differentiated between improvements in hardware (eg, improvements to circuit structures such as diodes, transistors, switches, etc.) or improvements in software (improvements in method flow). However, with the development of technology, the improvement of many methods and processes today can be regarded as a direct improvement of the hardware circuit structure. Designers almost get the corresponding hardware circuit structure by programming the improved method flow into the hardware circuit. Therefore, it cannot be said that the improvement of a method flow cannot be realized by hardware entity modules. For example, a Programmable Logic Device (PLD) (such as a Field Programmable Gate Array (FPGA)) is an integrated circuit whose logic function is determined by user programming of the device. It is programmed by the designer to "integrate" a digital system on a PLD, without the need for a chip manufacturer to design and generate a dedicated integrated circuit chip. Moreover, instead of manually generating integrated circuit chips, this kind of programming is now mostly implemented using "logic compiler" software, which is similar to the software compiler used in program development and writing, and needs to be compiled before compiling. The original code also has to be written in a specific programming language, which is called Hardware Description Language (HDL), and there is not only one HDL, but many kinds, such as ABEL (Advanced Boolean Expression Language) , AHDL (Altera Hardware Description Language), Confluence, CUPL (Cornell University Programming Language), HDCal, JHDL (Java Hardware Description Language), Lava, Lola, MyHDL, PALASM, RHDL (Ruby Hardware Description Language), etc., currently the most commonly used The ones are VHDL (Very-High-Speed Integrated Circuit Hardware Description Language) and Verilog. It should also be clear to those skilled in the art that a hardware circuit for implementing the logic method process can be easily obtained by simply programming the method process in the above-mentioned several hardware description languages and programming it into the integrated circuit.
控制器可以按任何适当的方式实现,例如,控制器可以采取例如微处理器或处理器以及存储可由该(微)处理器执行的计算机可读程序代码(例如软件或固件)的计算机可读介质、逻辑门、开关、专用集成电路(Application Specific Integrated Circuit,ASIC)、可编程逻辑控制器和嵌入微控制器的形式,控制器的例子包括但不限于以下微控制器:ARC 625D、Atmel AT91SAM、Microchip PIC18F26K20以及Silicone Labs C8051F320,存储器控制器还可以被实现为存储器的控制逻辑的一部分。本领域技术人员也知道,除了以纯计算机可读程序代码方式实现控制器以外,完全可以通过将方法步骤进行逻辑编程来使得控制器以逻辑门、开关、专用集成电路、可编程逻辑控制器和嵌入微控制器等的形式来实现相同功能。因此这种控制器可以被认为是一种硬件部件,而对其内包括的用于实现各种功能的装置也可以视为硬件部件内的结构。或者甚至,可以将用于实现各种功能的装置视为既可以是实现方法的软件模块又可以是硬件部件内的结构。The controller may be implemented in any suitable manner, for example, the controller may take the form of eg a microprocessor or processor and a computer readable medium storing computer readable program code (eg software or firmware) executable by the (micro)processor , logic gates, switches, application specific integrated circuits (ASICs), programmable logic controllers and embedded microcontrollers, examples of controllers include but are not limited to the following microcontrollers: ARC 625D, Atmel AT91SAM, Microchip PIC18F26K20 and Silicon Labs C8051F320, the memory controller can also be implemented as part of the control logic of the memory. Those skilled in the art also know that, in addition to implementing the controller in the form of pure computer-readable program code, the controller can be implemented as logic gates, switches, application-specific integrated circuits, programmable logic controllers and embedded devices by logically programming the method steps. The same function can be realized in the form of a microcontroller, etc. Therefore, such a controller can be regarded as a hardware component, and the devices included therein for realizing various functions can also be regarded as a structure within the hardware component. Or even, the means for implementing various functions can be regarded as both a software module implementing a method and a structure within a hardware component.
上述实施例阐明的系统、装置、模块或单元,具体可以由计算机芯片或实体实现,或者由具有某种功能的产品来实现。一种典型的实现设备为计算机。具体的,计算机例如可以为个人计算机、膝上型计算机、蜂窝电话、相机电话、智能电话、个人数字助理、媒体播放器、导航设备、电子邮件设备、游戏控制台、平板计算机、可穿戴设备或者这些设备中的任何设备的组合。The systems, devices, modules or units described in the above embodiments may be specifically implemented by computer chips or entities, or by products with certain functions. A typical implementation device is a computer. Specifically, the computer can be, for example, a personal computer, a laptop computer, a cellular phone, a camera phone, a smart phone, a personal digital assistant, a media player, a navigation device, an email device, a game console, a tablet computer, a wearable device, or A combination of any of these devices.
为了描述的方便,描述以上装置时以功能分为各种单元分别描述。当然,在实施本公开时可以把各单元的功能在同一个或多个软件和/或硬件中实现。For the convenience of description, when describing the above device, the functions are divided into various units and described respectively. Of course, when implementing the present disclosure, the functions of each unit may be implemented in one or more software and/or hardware.
本领域内的技术人员应明白,本发明的实施例可提供为方法、系统、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。As will be appreciated by one skilled in the art, embodiments of the present invention may be provided as a method, system, or computer program product. Accordingly, the present invention may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, the present invention may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, etc.) having computer-usable program code embodied therein.
本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理 设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。The present invention is described with reference to flowchart illustrations and/or block diagrams of methods, apparatus (systems), and computer program products according to embodiments of the invention. It will be understood that each flow and/or block in the flowchart illustrations and/or block diagrams, and combinations of flows and/or blocks in the flowchart illustrations and/or block diagrams, can be implemented by computer program instructions. These computer program instructions may be provided to the processor of a general purpose computer, special purpose computer, embedded processor or other programmable data processing device to produce a machine such that the instructions executed by the processor of the computer or other programmable data processing device produce Means for implementing the functions specified in a flow or flow of a flowchart and/or a block or blocks of a block diagram.
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。These computer program instructions may also be stored in a computer-readable memory capable of directing a computer or other programmable data processing apparatus to function in a particular manner, such that the instructions stored in the computer-readable memory result in an article of manufacture comprising instruction means, the instructions The apparatus implements the functions specified in the flow or flow of the flowcharts and/or the block or blocks of the block diagrams.
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。These computer program instructions can also be loaded on a computer or other programmable data processing device to cause a series of operational steps to be performed on the computer or other programmable device to produce a computer-implemented process such that The instructions provide steps for implementing the functions specified in the flow or blocks of the flowcharts and/or the block or blocks of the block diagrams.
在一个典型的配置中,计算设备包括一个或多个处理器(CPU)、输入/输出接口、网络接口和内存。In a typical configuration, a computing device includes one or more processors (CPUs), input/output interfaces, network interfaces, and memory.
内存可能包括计算机可读介质中的非永久性存储器,随机存取存储器(RAM)和/或非易失性内存等形式,如只读存储器(ROM)或闪存(flash RAM)。内存是计算机可读介质的示例。Memory may include forms of non-persistent memory, random access memory (RAM) and/or non-volatile memory in computer readable media, such as read only memory (ROM) or flash memory (flash RAM). Memory is an example of a computer-readable medium.
计算机可读介质包括永久性和非永久性、可移动和非可移动媒体可以由任何方法或技术来实现信息存储。信息可以是计算机可读指令、数据结构、程序的模块或其他数据。计算机的存储介质的例子包括,但不限于相变内存(PRAM)、静态随机存取存储器(SRAM)、动态随机存取存储器(DRAM)、其他类型的随机存取存储器(RAM)、只读存储器(ROM)、电可擦除可编程只读存储器(EEPROM)、快闪记忆体或其他内存技术、只读光盘只读存储器(CD-ROM)、数字多功能光盘(DVD)或其他光学存储、磁盒式磁带,磁带磁磁盘存储或其他磁性存储设备或任何其他非传输介质,可用于存储可以被计算设备访问的信息。按照本文中的界定,计算机可读介质不包括暂存电脑可读媒体(transitory media),如调制的数据信号和载波。Computer-readable media includes both persistent and non-permanent, removable and non-removable media, and storage of information may be implemented by any method or technology. Information may be computer readable instructions, data structures, modules of programs, or other data. Examples of computer storage media include, but are not limited to, phase-change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM), read only memory (ROM), Electrically Erasable Programmable Read Only Memory (EEPROM), Flash Memory or other memory technology, Compact Disc Read Only Memory (CD-ROM), Digital Versatile Disc (DVD) or other optical storage, Magnetic tape cassettes, magnetic tape magnetic disk storage or other magnetic storage devices or any other non-transmission medium that can be used to store information that can be accessed by a computing device. As defined herein, computer-readable media does not include transitory computer-readable media, such as modulated data signals and carrier waves.
还需要说明的是,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、商品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、商品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包 括所述要素的过程、方法、商品或者设备中还存在另外的相同要素。It should also be noted that the terms "comprising", "comprising" or any other variation thereof are intended to encompass a non-exclusive inclusion such that a process, method, article or device comprising a series of elements includes not only those elements, but also Other elements not expressly listed or inherent to such a process, method, article of manufacture or apparatus are also included. Without further limitation, an element qualified by the phrase "comprising a..." does not preclude the presence of additional identical elements in a process, method, article of manufacture or apparatus that includes the element.
本领域技术人员应明白,本公开的实施例可提供为方法、系统或计算机程序产品。因此,本公开可采用完全硬件实施例、完全软件实施例或结合软件和硬件方面的实施例的形式。而且,本公开可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。As will be appreciated by one skilled in the art, embodiments of the present disclosure may be provided as a method, system or computer program product. Accordingly, the present disclosure may take the form of an entirely hardware embodiment, an entirely software embodiment, or an embodiment combining software and hardware aspects. Furthermore, the present disclosure may take the form of a computer program product embodied on one or more computer-usable storage media (including, but not limited to, disk storage, CD-ROM, optical storage, etc.) having computer-usable program code embodied therein.
本公开可以在由计算机执行的计算机可执行指令的一般上下文中描述,例如程序模块。一般地,程序模块包括执行特定任务或实现特定抽象数据类型的例程、程序、对象、组件、数据结构等等。也可以在分布式计算环境中实践本公开,在这些分布式计算环境中,由通过通信网络而被连接的远程处理设备来执行任务。在分布式计算环境中,程序模块可以位于包括存储设备在内的本地和远程计算机存储介质中。The present disclosure may be described in the general context of computer-executable instructions, such as program modules, being executed by a computer. Generally, program modules include routines, programs, objects, components, data structures, etc. that perform particular tasks or implement particular abstract data types. The disclosure may also be practiced in distributed computing environments where tasks are performed by remote processing devices that are linked through a communications network. In a distributed computing environment, program modules may be located in both local and remote computer storage media including storage devices.
本公开中的各个实施例均采用递进的方式描述,各个实施例之间相同相似的部分互相参见即可,每个实施例重点说明的都是与其他实施例的不同之处。尤其,对于系统实施例而言,由于其基本相似于方法实施例,所以描述的比较简单,相关之处参见方法实施例的部分说明即可。The various embodiments in the present disclosure are described in a progressive manner, and the same and similar parts between the various embodiments may be referred to each other, and each embodiment focuses on the differences from other embodiments. In particular, as for the system embodiments, since they are basically similar to the method embodiments, the description is relatively simple, and for related parts, please refer to the partial descriptions of the method embodiments.
以上所述仅为本公开的实施例而已,并不用于限制本公开。对于本领域技术人员来说,本公开可以有各种更改和变化。凡在本公开的精神和原理之内所作的任何修改、等同替换、改进等,均应包含在本公开的权利要求范围之内。The above descriptions are merely embodiments of the present disclosure, and are not intended to limit the present disclosure. Various modifications and variations of the present disclosure will occur to those skilled in the art. Any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present disclosure shall be included within the scope of the claims of the present disclosure.

Claims (10)

  1. 一种无人驾驶设备的定位方法,包括:A positioning method for an unmanned device, comprising:
    确定无人驾驶设备当前所处目标区域;Determine the target area where the unmanned equipment is currently located;
    根据所述目标区域中未遮挡卫星信号的区域占比,以及预先拟合的定位偏差函数,确定所述无人驾驶设备当前进行卫星定位的结果置信度,其中,所述定位偏差函数根据历史上多个区域中未遮挡卫星信号的区域占比以及在多个区域内的定位偏差拟合得到;According to the proportion of the unobstructed satellite signal in the target area and the pre-fitted positioning deviation function, the confidence level of the current satellite positioning result of the unmanned device is determined, wherein the positioning deviation function is based on historical The proportion of unobstructed satellite signals in multiple areas and the positioning deviation in multiple areas are obtained by fitting;
    根据接收到的多个卫星的卫星信号,确定所述无人驾驶设备当前的卫星定位位置;Determine the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites;
    根据所述无人驾驶设备当前的卫星定位位置,以及当前进行卫星定位的结果置信度,对所述无人驾驶设备进行融合定位,确定所述无人驾驶设备的融合定位位置。According to the current satellite positioning position of the unmanned device and the confidence level of the current satellite positioning result, the unmanned device is fused to locate the unmanned device, and the fused positioning position of the unmanned device is determined.
  2. 如权利要求1所述的方法,其中,确定所述无人驾驶设备当前进行卫星定位的结果置信度,包括:The method of claim 1, wherein determining the confidence level of the satellite positioning result currently performed by the unmanned device comprises:
    根据所述定位偏差函数输出的第一定位偏差,以及历史上在所述目标区域确定的第二定位偏差,确定所述无人驾驶设备在所述目标区域进行卫星定位的定位偏差;According to the first positioning deviation output by the positioning deviation function, and the second positioning deviation determined in the history of the target area, determine the positioning deviation of the satellite positioning performed by the unmanned device in the target area;
    根据所述无人驾驶设备在所述目标区域进行卫星定位的定位偏差,确定所述无人驾驶设备当前进行卫星定位的结果置信度。According to the positioning deviation of the satellite positioning performed by the unmanned device in the target area, the confidence level of the result of the current satellite positioning performed by the unmanned device is determined.
  3. 如权利要求1或2所述的方法,其中,根据所述无人驾驶设备当前的卫星定位位置,以及当前进行卫星定位的结果置信度,对所述无人驾驶设备进行融合定位,确定所述无人驾驶设备的融合定位位置,包括:The method according to claim 1 or 2, wherein, according to the current satellite positioning position of the unmanned device and the confidence of the result of the current satellite positioning, the unmanned device is fused and positioned to determine the said unmanned device. The fusion positioning position of unmanned equipment, including:
    响应于所述结果置信度大于预设阈值,根据所述卫星定位位置以及其它定位方式,进行融合定位,确定所述无人驾驶设备的融合定位位置,其中所述其它定位方式包括IMU定位、激光雷达定位以及视觉定位中的一种或多种;In response to the confidence of the result being greater than a preset threshold, perform fusion positioning according to the satellite positioning position and other positioning methods, and determine the fusion positioning position of the unmanned device, wherein the other positioning methods include IMU positioning, laser positioning One or more of radar positioning and visual positioning;
    响应于所述结果置信度小于等于预设阈值,根据其它定位方式,确定所述无人驾驶设备的融合定位位置。In response to the result confidence being less than or equal to a preset threshold, the fusion positioning position of the unmanned device is determined according to other positioning methods.
  4. 如权利要求2所述的方法,其中,所述方法还包括:The method of claim 2, wherein the method further comprises:
    根据所述无人驾驶设备的融合定位位置以及所述无人驾驶设备的卫星定位位置,确定在所述目标区域内进行卫星定位的增量偏差;Determine the incremental deviation of satellite positioning in the target area according to the fusion positioning position of the unmanned device and the satellite positioning position of the unmanned device;
    根据在所述目标区域内进行卫星定位的增量偏差,更新历史上在所述目标区域内进行卫星定位的第二定位偏差。According to the incremental deviation of the satellite positioning in the target area, the second positioning deviation of the satellite positioning in the target area in the history is updated.
  5. 如权利要求4所述的方法,其中,根据在所述目标区域内进行卫星定位的增量偏差,更新历史上在所述目标区域内进行卫星定位的第二定位偏差,包括:The method of claim 4, wherein, according to the incremental deviation of satellite positioning in the target area, updating the historical second positioning deviation of satellite positioning in the target area, comprising:
    根据历史上若干次在所述目标区域内进行卫星定位的增量偏差的平均值,更新历史 上在所述目标区域内进行卫星定位的第二定位偏差。The second positioning deviation of the historical satellite positioning in the target area is updated according to the average value of the incremental deviations of the satellite positioning in the target area for several times in the history.
  6. 如权利要求1所述的方法,其中,拟合定位偏差函数,包括:The method of claim 1, wherein fitting the positioning deviation function comprises:
    获取历史上在预先划分的多个区域内通过卫星定位产生的定位偏差;Obtain the historical positioning deviation generated by satellite positioning in multiple pre-divided areas;
    针对所述预先划分的多个区域的每个区域,根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比;For each area of the pre-divided multiple areas, according to the obstacle information of one or more obstacles corresponding to the area, determine the proportion of areas in the area that receive satellite signals that are not blocked by obstacles;
    根据所述多个区域内未遮挡卫星信号的区域占比,以及在所述多个区域内产生的定位偏差,拟合得到定位偏差函数。The positioning deviation function is obtained by fitting according to the proportion of the unobstructed satellite signals in the multiple regions and the positioning deviation generated in the multiple regions.
  7. 如权利要求6所述的方法,其中,根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比,包括:The method according to claim 6, wherein, according to the obstacle information of one or more obstacles corresponding to the area, determining the proportion of the area receiving satellite signals in the area that is not blocked by obstacles, comprising:
    根据该区域对应的一个或多个障碍物的障碍物信息,确定在该区域中心点位置接收卫星信号未被障碍物遮挡的角度范围;According to the obstacle information of one or more obstacles corresponding to the area, determine the angular range in which the satellite signal is received at the center point of the area without being blocked by obstacles;
    根据在该区域中心点位置接收卫星信号未被障碍物遮挡的角度范围,确定在该区域内接收卫星信号未被障碍物遮挡的区域占比。According to the angular range of receiving satellite signals at the center point of the area that is not blocked by obstacles, determine the proportion of the area where satellite signals are received and not blocked by obstacles in the area.
  8. 一种无人驾驶设备的定位装置,包括:A positioning device for unmanned equipment, comprising:
    区域确定模块,确定无人驾驶设备当前所处目标区域;The area determination module determines the target area where the unmanned equipment is currently located;
    置信度确定模块,根据所述目标区域中未遮挡卫星信号的区域占比,以及预先拟合的定位偏差函数,确定所述无人驾驶设备当前进行卫星定位的结果置信度,其中,所述定位偏差函数根据历史上多个区域中未遮挡卫星信号的区域占比以及在多个区域内的定位偏差拟合得到;The confidence level determination module determines the confidence level of the current satellite positioning result performed by the unmanned device according to the proportion of the unobstructed satellite signal in the target area and the pre-fitted positioning deviation function, wherein the positioning The deviation function is fitted according to the proportion of unobstructed satellite signals in multiple regions in history and the positioning deviation in multiple regions;
    卫星定位模块,根据接收到的多个卫星的卫星信号,确定所述无人驾驶设备当前的卫星定位位置;a satellite positioning module, for determining the current satellite positioning position of the unmanned device according to the received satellite signals of multiple satellites;
    融合定位模块,根据所述无人驾驶设备当前的卫星定位位置,以及当前进行卫星定位的结果置信度,对所述无人驾驶设备进行融合定位,确定所述无人驾驶设备的融合定位位置。The fusion positioning module performs fusion positioning on the unmanned equipment according to the current satellite positioning position of the unmanned equipment and the confidence level of the current satellite positioning result, and determines the fusion positioning position of the unmanned equipment.
  9. 一种计算机可读存储介质,所述存储介质存储有计算机程序,所述计算机程序被处理器执行时实现上述权利要求1-7任一所述的方法。A computer-readable storage medium storing a computer program, when the computer program is executed by a processor, implements the method according to any one of the preceding claims 1-7.
  10. 一种无人驾驶设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现上述权利要求1-7任一所述的方法。An unmanned vehicle, comprising a memory, a processor and a computer program stored in the memory and running on the processor, the processor implementing the method according to any one of claims 1-7 when the processor executes the program .
PCT/CN2022/086368 2021-04-12 2022-04-12 Unmanned driving device WO2022218306A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202110385914.4A CN112859131B (en) 2021-04-12 2021-04-12 Positioning method and device of unmanned equipment
CN202110385914.4 2021-04-12

Publications (1)

Publication Number Publication Date
WO2022218306A1 true WO2022218306A1 (en) 2022-10-20

Family

ID=75992404

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/086368 WO2022218306A1 (en) 2021-04-12 2022-04-12 Unmanned driving device

Country Status (2)

Country Link
CN (1) CN112859131B (en)
WO (1) WO2022218306A1 (en)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112859131B (en) * 2021-04-12 2021-09-07 北京三快在线科技有限公司 Positioning method and device of unmanned equipment
CN114111808A (en) * 2021-11-30 2022-03-01 上汽通用五菱汽车股份有限公司 Positioning method, system and device of unmanned vehicle and readable storage medium

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109470256A (en) * 2017-09-07 2019-03-15 高德信息技术有限公司 A kind of localization method and device
CN109474894A (en) * 2019-01-03 2019-03-15 腾讯科技(深圳)有限公司 Terminal positioning processing method, device and electronic equipment
US20190110270A1 (en) * 2017-10-06 2019-04-11 Skycatch, Inc. Determining the location of a uav in flight utilizing real time kinematic satellite navigation and precise point positioning
CN110221328A (en) * 2019-07-23 2019-09-10 广州小鹏汽车科技有限公司 A kind of Combinated navigation method and device
CN110658542A (en) * 2019-10-10 2020-01-07 安徽江淮汽车集团股份有限公司 Method, device, equipment and storage medium for positioning and identifying automatic driving automobile
CN111077555A (en) * 2020-03-24 2020-04-28 北京三快在线科技有限公司 Positioning method and device
CN112859131A (en) * 2021-04-12 2021-05-28 北京三快在线科技有限公司 Positioning method and device of unmanned equipment

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5959577A (en) * 1997-08-28 1999-09-28 Vectorlink, Inc. Method and structure for distribution of travel information using network
CN104950300B (en) * 2015-05-28 2017-08-11 北京科技大学 A kind of TOA range errors correcting method differentiated based on sighting distance and non line of sight and system
DE102017210138A1 (en) * 2017-06-16 2018-12-20 Robert Bosch Gmbh Method and device for sending correction data and for determining a high-precision position of a mobile unit
CN108254766B (en) * 2017-12-01 2021-08-24 广州比逊电子科技有限公司 Satellite multipath error resisting method
CN108414974B (en) * 2018-01-26 2022-04-01 西北工业大学 Indoor positioning method based on ranging error correction
CN109597027B (en) * 2018-12-06 2021-08-17 清华大学 Positioning system and method based on single base station
CN111709517B (en) * 2020-06-12 2022-07-29 武汉中海庭数据技术有限公司 Method and device for enhancing redundancy fusion positioning based on confidence prediction system
CN112462403A (en) * 2020-11-03 2021-03-09 北京三快在线科技有限公司 Positioning method, positioning device, storage medium and electronic equipment

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109470256A (en) * 2017-09-07 2019-03-15 高德信息技术有限公司 A kind of localization method and device
US20190110270A1 (en) * 2017-10-06 2019-04-11 Skycatch, Inc. Determining the location of a uav in flight utilizing real time kinematic satellite navigation and precise point positioning
CN109474894A (en) * 2019-01-03 2019-03-15 腾讯科技(深圳)有限公司 Terminal positioning processing method, device and electronic equipment
CN110221328A (en) * 2019-07-23 2019-09-10 广州小鹏汽车科技有限公司 A kind of Combinated navigation method and device
CN110658542A (en) * 2019-10-10 2020-01-07 安徽江淮汽车集团股份有限公司 Method, device, equipment and storage medium for positioning and identifying automatic driving automobile
CN111077555A (en) * 2020-03-24 2020-04-28 北京三快在线科技有限公司 Positioning method and device
CN112859131A (en) * 2021-04-12 2021-05-28 北京三快在线科技有限公司 Positioning method and device of unmanned equipment

Also Published As

Publication number Publication date
CN112859131A (en) 2021-05-28
CN112859131B (en) 2021-09-07

Similar Documents

Publication Publication Date Title
WO2022218306A1 (en) Unmanned driving device
WO2022127532A1 (en) Method and apparatus for calibrating external parameter of laser radar and imu, and device
CN111077549B (en) Position data correction method, apparatus and computer readable storage medium
CN111077555B (en) Positioning method and device
US11281228B2 (en) Method and device for determining a position of a transportation vehicle
CN104457789A (en) Inertial-navigation-based parameter correcting method and device
US11555705B2 (en) Localization using dynamic landmarks
US20130131984A1 (en) Rapid lidar image correlation for ground navigation
US11761787B2 (en) Map information correction method, driving assistance method, and map information correction device
KR20180038154A (en) Method for vehicle pose estimation using LiDAR
WO2023004956A1 (en) Laser slam method and system in high-dynamic environment, and device and storage medium
CN115077541A (en) Positioning method and device for automatic driving vehicle, electronic equipment and storage medium
KR20220052312A (en) Vehicle positioning method, apparatus and autonomous driving vehicle
US20200126429A1 (en) Method, device, and computer-readable storage medium with instructions for estimating the pose of a transportation vehicle
US20230251095A1 (en) Vehicle positioning method and apparatus
JP7113996B2 (en) High-precision map database generation device and high-precision map database generation method
WO2023185215A1 (en) Data calibration
CN116176603A (en) Method, device and equipment for determining course angle of vehicle
JP6819441B2 (en) Target position estimation method and target position estimation device
CN112229401B (en) Measurement information synchronous extrapolation method and system suitable for INS-GPS pseudo range fusion
CN115435796A (en) Vehicle positioning method and device and electronic equipment
CN114739416A (en) Automatic driving vehicle positioning method and device, electronic equipment and storage medium
CN112230256A (en) Autonomous robot, positioning calibration method and device thereof, and storage medium
CN117346768B (en) Multi-sensor fusion sensing positioning method suitable for indoor and outdoor
CN113848957B (en) Ground unmanned vehicle formation control device and method

Legal Events

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

Ref document number: 22787529

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 22787529

Country of ref document: EP

Kind code of ref document: A1