WO2024098463A1 - Vehicle localization method and apparatus, and vehicle - Google Patents

Vehicle localization method and apparatus, and vehicle Download PDF

Info

Publication number
WO2024098463A1
WO2024098463A1 PCT/CN2022/133346 CN2022133346W WO2024098463A1 WO 2024098463 A1 WO2024098463 A1 WO 2024098463A1 CN 2022133346 W CN2022133346 W CN 2022133346W WO 2024098463 A1 WO2024098463 A1 WO 2024098463A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
positioning
information
target
positioning information
Prior art date
Application number
PCT/CN2022/133346
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 WO2024098463A1 publication Critical patent/WO2024098463A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/06Automatic manoeuvring for parking
    • 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
    • G01S19/48Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system

Definitions

  • the present disclosure relates to the field of vehicle control technology, and in particular, to a vehicle positioning method, device and vehicle.
  • the automatic parking system is a driving assistance system that helps the driver identify available parking spaces and automatically drives the vehicle into the available parking spaces.
  • Automatic parking uses the vehicle's visual sensors or ultrasonic radar to perceive the surrounding environment, plans the parking method and path in the central processor, and controls the vehicle to automatically drive into the parking space.
  • the positioning of the vehicle's automatic parking system in the parking lot relies on the vehicle's own sensors, generally using laser radar for SLAM (simultaneous localization and mapping) to build a parking lot map, and based on the position recorded when the vehicle is parked in the parking lot, this position is used as the initial position of the vehicle in the SLAM map before the vehicle is powered on and driven.
  • SLAM simultaneous localization and mapping
  • the vehicle position recorded by the automatic parking system when it was parked before the power was turned off is inconsistent with the actual position of the vehicle when it was started, resulting in a large deviation in the vehicle positioning.
  • the purpose of the present disclosure is to provide a vehicle positioning method, device and vehicle to solve the problem of large vehicle positioning deviation caused by moving the vehicle when the automatic parking system is not activated.
  • the present disclosure provides a vehicle positioning method, the method comprising:
  • the target positioning information of the vehicle is determined.
  • the step of determining a target positioning mode from different positioning modes according to a size relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold value includes:
  • the target positioning mode is determined to be a first positioning mode, where the first positioning mode is a mode of determining the first positioning information as the target positioning information.
  • the step of determining a target positioning mode from different positioning modes according to a size relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold value includes:
  • the target positioning method is determined to be a second positioning method, where the second positioning method is a method of determining the target positioning information based on an environmental image around the vehicle and the first positioning information.
  • the step of determining the target positioning information of the vehicle according to the target positioning method includes:
  • the target positioning mode is the second positioning mode
  • the target positioning information is obtained according to the numbering information and the first positioning information.
  • the step of obtaining the target positioning information according to the numbering information and the first positioning information includes:
  • the ICP algorithm is used to align the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information.
  • the step of registering the real-time point cloud information and the parking spot point cloud information using an ICP algorithm to obtain the target positioning information includes:
  • the value of the feature matrix is iteratively calculated using the least square method to obtain a target feature matrix
  • the target positioning information is obtained according to the target feature matrix.
  • the step of obtaining the target positioning information according to the target feature matrix includes:
  • the target feature matrix is solved by using the SVD method to obtain a target rotation matrix
  • the target positioning information is obtained according to the target rotation matrix.
  • the method further includes:
  • the vehicle's driving path is obtained based on the actual position and the target position input by the user.
  • the present disclosure also provides a vehicle positioning device, the device comprising:
  • An acquisition module used for acquiring the first positioning information of the vehicle and the second positioning information stored before the vehicle was powered off last time after the vehicle was powered on;
  • a first determination module configured to determine a target positioning mode from different positioning modes according to a magnitude relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold;
  • the second determination module is used to determine the target positioning information of the vehicle according to the target positioning method.
  • the present disclosure further provides a vehicle, the vehicle comprising:
  • a processor and a memory wherein the memory stores machine executable instructions that can be executed by the processor, and the processor is used to execute the machine executable instructions to implement the above-mentioned vehicle positioning method.
  • the embodiment of the present disclosure determines a target positioning method based on a relationship between a deviation value between first positioning information obtained after the vehicle is powered on and second positioning information stored before the vehicle was last powered off and a preset deviation threshold, and determines the target positioning information based on the target positioning method.
  • the present disclosure uses the deviation value between the first positioning information obtained after the vehicle is powered on and the second positioning information stored before the vehicle is powered off as the basis for selecting the target positioning method, and selects different positioning methods when the vehicle positioning deviation size is different.
  • the positioning method determined after comparing the difference size between the positioning information of the vehicle after power-on and before power-off can effectively solve the problem of large positioning deviation after moving the vehicle when the automatic parking system of the vehicle is not started, and improves the positioning accuracy of the vehicle in occluded scenarios.
  • Fig. 1 is a flow chart showing a vehicle positioning method according to an exemplary embodiment.
  • Fig. 2 is a block diagram of a vehicle positioning device according to an exemplary embodiment.
  • Fig. 3 is a schematic diagram of a functional block diagram of a vehicle according to an exemplary embodiment.
  • Fig. 4 is a block diagram showing a device for a vehicle positioning method according to an exemplary embodiment.
  • SLAM SLAM technology
  • Sensors can be used to achieve autonomous positioning, mapping, and path planning of machines.
  • Vehicle sensors can include lidar, millimeter-wave radar, ultrasonic radar, and visual sensors.
  • Integrated navigation refers to a navigation system that integrates various navigation devices and is controlled by a monitor and a computer. Most integrated navigation systems are based on inertial navigation systems. The main reason is that inertial navigation can provide more navigation parameters and full attitude information parameters. However, when the vehicle is parked in a covered parking lot, the combined navigation has poor satellite search performance and cannot provide accurate positioning of the vehicle when the signal is blocked. When the laser SLAM technology is used to locate the environment in which the vehicle is located, the poor robustness of the SLAM algorithm leads to a large deviation in vehicle positioning.
  • the driver may complete the parking space change without the parking system being started normally.
  • the vehicle position recorded by the automatic parking system when parking before power is turned off is inconsistent with the actual position of the started vehicle, resulting in a large deviation in vehicle positioning.
  • an embodiment of the present disclosure provides a concept for solving the above problems. Based on the deviation value between the first positioning information obtained after power-on and the second positioning information stored before the vehicle was last powered off, as well as a preset deviation threshold, a target positioning method is determined from different positioning methods, thereby obtaining target positioning information.
  • FIG. 1 is a flow chart of a vehicle positioning method according to an exemplary embodiment. As shown in FIG. 1 , the vehicle positioning method includes:
  • the first positioning information is obtained by repositioning the vehicle after power-on, and the second positioning information is stored before the vehicle is powered off after the last trip. Both the first positioning information and the second positioning information are positioned according to the sensors on the vehicle, and the map constructed by SLAM is displayed on the vehicle's head-mounted entertainment control system (HUT).
  • the vehicle's sensors may include inertial measurement units (IMU), laser radars, millimeter-wave radars, ultrasonic radars, and cameras.
  • the driver turns on the vehicle's automatic parking system.
  • the automatic parking system will record the vehicle's second positioning information before power is turned off and store it in the vehicle controller to determine the vehicle's actual positioning position after the vehicle is powered on.
  • S102 Determine a target positioning method from different positioning methods according to a deviation value between the first positioning information and the second positioning information and a size relationship between a preset deviation threshold.
  • the deviation value is obtained based on the first positioning information and the second positioning information
  • the preset deviation threshold can be determined according to the size of the vehicle itself and the error of the sensor.
  • the larger the size of the vehicle itself and the larger the sensor error the larger the deviation value, and vice versa.
  • the existing positioning method directly determines the initial position of this trip based on the positioning information after the vehicle is re-positioned by the sensor and combined navigation after this power-on. In this case, the positioning information of the vehicle before power-off may not be stored before the vehicle is powered off.
  • the existing positioning method generally determines the initial position of the vehicle for this trip based on the stored positioning information before the last power-off, or determines the initial position of the vehicle for this trip based on the positioning information re-acquired after the vehicle is powered on.
  • the target positioning method is a positioning method determined from different positioning methods.
  • the positioning methods may include multiple methods.
  • the target positioning information may be obtained based on a SLAM algorithm.
  • the target positioning information may be obtained based on a track recursion method.
  • vehicle positioning can also be achieved based on data collected by multiple vehicle sensors, thereby avoiding the situation where the vehicle cannot perform self-positioning due to failure of a single sensor, thereby improving the robustness of the positioning result.
  • the positioning method can specifically determine the initial position of the vehicle based on the first positioning information determined after the vehicle is powered on, or it can determine the initial position of the vehicle based on the environmental image of the current surroundings of the vehicle and the positioning information stored before power-off.
  • S103 Determine the target positioning information of the vehicle according to the target positioning method.
  • the target positioning information is used to determine the initial position of the vehicle after power-on.
  • the target positioning information of the vehicle can be obtained according to the target positioning method.
  • the first positioning information is directly determined as the target positioning information; or, when the deviation value between the first positioning information and the second positioning information is greater than the preset deviation threshold, the number information of the parking space where the vehicle is currently located is identified according to the vehicle environment image, and a matching operation is performed according to the number information and the first positioning information to obtain the updated target positioning information.
  • the embodiment of the present disclosure determines a target positioning method based on a relationship between a deviation value between first positioning information obtained after the vehicle is powered on and second positioning information stored before the vehicle was last powered off and a preset deviation threshold, and determines the target positioning information based on the target positioning method.
  • the present disclosure uses the deviation value between the first positioning information obtained after the vehicle is powered on and the second positioning information stored before the vehicle is powered off as the basis for selecting the target positioning method, and selects different positioning methods when the vehicle positioning deviation size is different.
  • the positioning method determined after comparing the difference size between the positioning information of the vehicle after power-on and before power-off can effectively solve the problem of large positioning deviation after moving the vehicle when the automatic parking system of the vehicle is not started, and improves the positioning accuracy of the vehicle in occluded scenarios.
  • the step of determining the target positioning mode from different positioning modes according to the deviation value between the first positioning information and the second positioning information and the size relationship between the preset deviation threshold value includes:
  • the target positioning mode is determined to be the first positioning mode, where the first positioning mode is a mode of determining the first positioning information as the target positioning information.
  • the deviation value when the deviation value is less than the deviation threshold, the deviation value is within the positioning deviation range, and it is determined that the vehicle has not moved after the automatic parking system is turned off or the position has not moved too far.
  • the first positioning information obtained by the vehicle after this power-on can be used as the target positioning information of the current vehicle.
  • the step of determining the target positioning mode from different positioning modes according to the deviation value between the first positioning information and the second positioning information and the size relationship between the preset deviation threshold value includes:
  • the target positioning method is determined to be the second positioning method, which is a method of determining the target positioning information based on the environmental image around the vehicle and the first positioning information.
  • the vehicle's visual sensor can be used to obtain the environmental image around the vehicle.
  • the visual sensor is a camera device that comes with the vehicle. According to the environmental image and the first positioning information obtained by repositioning the vehicle after power-on, the target positioning information of the vehicle is matched.
  • the step of determining the target positioning information of the vehicle according to the target positioning method includes:
  • the target positioning mode is the second positioning mode
  • the number information of the parking space where the vehicle is located is obtained
  • the target positioning information is obtained according to the numbering information and the first positioning information.
  • the parking space number information in the environmental image can be identified according to the image recognition algorithm. Since a map of the parking lot has been constructed according to SLAM before the vehicle was last powered off, when the camera device recognizes the number information of the parking space where the vehicle is currently located, the number information can be matched and located in the constructed map to obtain the target positioning information.
  • the image recognition algorithm is not specifically limited here.
  • it can be an image recognition algorithm based on a deep neural network, an image recognition algorithm based on a classifier, and an image recognition algorithm based on a support vector machine (SVM).
  • SVM support vector machine
  • the step of obtaining target positioning information according to the numbering information and the first positioning information includes:
  • the ICP algorithm is used to align the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information.
  • the real-time point cloud information is the coordinates of the point set used to characterize the vehicle position obtained according to the first positioning information
  • the parking point cloud information is the coordinates of the point set used to characterize the parking space position of the vehicle.
  • the ICP algorithm is based on the data registration method and uses the nearest point search method to solve an algorithm based on free-form surfaces.
  • the step of using the ICP algorithm to register the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information includes:
  • the value of the feature matrix is iteratively calculated using the least square method to obtain the target feature matrix
  • the target positioning information is obtained.
  • the value of the feature matrix of the real-time point cloud is initialized based on the coordinate system where the parking point cloud information is located, and each coordinate point in the real-time point cloud information is assigned a value.
  • the distance condition can be that the distance between the matching point obtained in the parking point cloud information and the real-time point cloud information is less than a preset distance threshold.
  • the points in the real-time point cloud information and the parking point cloud information are matched, and each point in the real-time point cloud information and the parking point cloud information is a vector. According to the distance between the matching points between the real-time point cloud information and the parking point cloud information, the value of the feature matrix is iteratively updated using the least squares method to minimize the error function, and finally the optimized target feature matrix is obtained.
  • the ICP algorithm steps may be:
  • the characteristic matrix includes the rotation matrix R and the translation matrix t;
  • step (2) If d is less than a given threshold or greater than the preset maximum number of iterations, the iterative calculation is stopped. Otherwise, return to step (2) until the convergence condition is met.
  • the step of obtaining target positioning information according to the target feature matrix includes:
  • the SVD method is used to solve the target feature matrix and obtain the target rotation matrix
  • the target positioning information is obtained.
  • the methods for solving the target feature matrix generally include the SVD method and the nonlinear optimization method.
  • the SVD algorithm is used for solving, and the specific steps include:
  • the method further includes:
  • the vehicle's driving path is obtained based on the actual position and the target position input by the user.
  • the vehicle controller can calculate the vehicle's driving path based on the actual position and the target position input by the user.
  • FIG. 2 is a block diagram of a vehicle positioning device according to an exemplary embodiment.
  • the vehicle positioning device 500 includes:
  • the acquisition module 520 is used to acquire the first positioning information of the vehicle and the second positioning information stored before the vehicle was powered off last time after the vehicle is powered on;
  • a first determination module 530 is used to determine a target positioning mode from different positioning modes according to a deviation value between the first positioning information and the second positioning information and a size relationship between a preset deviation threshold;
  • the second determination module 540 is used to determine the target positioning information of the vehicle according to the target positioning method.
  • the first determination module 530 includes:
  • the first determination submodule is used to determine that the target positioning mode is a first positioning mode when the deviation value is less than the deviation threshold.
  • the first positioning mode is a mode of determining the first positioning information as the target positioning information.
  • the first determination module 530 includes:
  • the second determination submodule is used to determine that the target positioning method is a second positioning method when the deviation value is greater than the deviation threshold.
  • the second positioning method is a method of determining the target positioning information based on the environmental image around the vehicle and the first positioning information.
  • the second determination module 540 includes:
  • An acquisition submodule used for acquiring an environment image when it is determined that the target positioning mode is the second positioning mode
  • the first obtaining submodule is used to obtain the number information of the parking space where the vehicle is located according to the environment image;
  • the second obtaining submodule is used to obtain target positioning information according to the numbering information and the first positioning information.
  • the second obtaining submodule is specifically used for:
  • the ICP algorithm is used to align the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information.
  • the second obtaining submodule is specifically used for:
  • the value of the feature matrix is iteratively calculated using the least square method to obtain the target feature matrix
  • the target positioning information is obtained.
  • the second obtaining submodule is specifically used for:
  • the SVD method is used to solve the target feature matrix and obtain the target rotation matrix
  • the target positioning information is obtained.
  • the vehicle positioning device 500 further includes:
  • An update module used to update the actual position of the vehicle in the map according to the target positioning information
  • the acquisition module is used to obtain the vehicle's driving path based on the actual position and the target position input by the user.
  • an embodiment of the present disclosure further provides a vehicle, the vehicle comprising:
  • a processor and a memory wherein the memory stores machine executable instructions that can be executed by the processor, and the processor is used to execute the machine executable instructions to implement the above-mentioned vehicle positioning method.
  • FIG3 is a functional block diagram of a vehicle 600 according to an exemplary embodiment.
  • the vehicle 600 may be a hybrid vehicle, a non-hybrid vehicle, an electric vehicle, a fuel cell vehicle, or other types of vehicles.
  • the vehicle 600 may be an autonomous vehicle, a semi-autonomous vehicle, or a non-autonomous vehicle.
  • the vehicle 600 may include various subsystems, such as an infotainment system 610, a perception system 620, a decision control system 630, a drive system 640, and a computing platform 650.
  • the vehicle 600 may also include more or fewer subsystems, and each subsystem may include multiple components.
  • each subsystem and each component of the vehicle 600 may be interconnected by wire or wireless means.
  • the infotainment system 610 may include a communication system, an entertainment system, and a navigation system, etc.
  • the perception system 620 may include several sensors for sensing information about the environment around the vehicle 600.
  • the perception system 620 may include a global positioning system (the global positioning system may be a GPS system, or a Beidou system or other positioning systems), an inertial measurement unit (IMU), a laser radar, a millimeter wave radar, an ultrasonic radar, and a camera device.
  • the global positioning system may be a GPS system, or a Beidou system or other positioning systems
  • IMU inertial measurement unit
  • laser radar a laser radar
  • millimeter wave radar a millimeter wave radar
  • ultrasonic radar an ultrasonic radar
  • the decision control system 630 may include a computing system, a vehicle controller, a steering system, a throttle, and a braking system.
  • the drive system 640 may include components that provide power movement for the vehicle 600.
  • the drive system 640 may include an engine, a torque source, a transmission system, and wheels.
  • the engine may be one or a combination of multiple of an internal combustion engine, an electric motor, and an air compression engine.
  • the engine is capable of converting the torque provided by the torque source into mechanical torque.
  • the computing platform 650 may include at least one processor 651 and a first memory 652, and the processor 651 may execute instructions 653 stored in the first memory 652.
  • the processor 651 may be any conventional processor, such as a commercially available CPU.
  • the processor may also include a graphics processor (Graphic Process Unit, GPU), a field programmable gate array (Field Programmable Gate Array, FPGA), a system on chip (System on Chip, SOC), an application specific integrated circuit (Application Specific Integrated Circuit, ASIC) or a combination thereof.
  • graphics processor Graphic Process Unit, GPU
  • field programmable gate array Field Programmable Gate Array
  • FPGA Field Programmable Gate Array
  • SOC System on Chip
  • ASIC Application Specific Integrated Circuit
  • the first memory 652 can be implemented by any type of volatile or non-volatile storage device or a combination thereof, such as static random access memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic memory, flash memory, magnetic disk or optical disk.
  • SRAM static random access memory
  • EEPROM electrically erasable programmable read-only memory
  • EPROM erasable programmable read-only memory
  • PROM programmable read-only memory
  • ROM read-only memory
  • magnetic memory magnetic memory
  • flash memory magnetic disk or optical disk.
  • the first memory 652 may also store data, such as road maps, route information, and data such as the location, direction, and speed of the vehicle.
  • the data stored in the first memory 652 may be used by the computing platform 650 .
  • the processor 651 may execute the instruction 653 to complete all or part of the steps of the above-mentioned vehicle positioning method.
  • FIG. 4 is a block diagram of a device 1900 for a vehicle positioning method according to an exemplary embodiment.
  • the device 1900 can be provided as a server.
  • the device 1900 includes a processing component 1922, which further includes one or more processors, and a memory resource represented by a second memory 1932 for storing instructions that can be executed by the processing component 1922, such as an application.
  • the application stored in the second memory 1932 may include one or more modules, each of which corresponds to a set of instructions.
  • the processing component 1922 is configured to execute instructions to perform the above-mentioned vehicle positioning method.
  • the device 1900 may also include a power supply component 1926 configured to perform power management of the device 1900, a wired or wireless network interface 1950 configured to connect the device 1900 to a network, and an input/output interface 1958.
  • the device 1900 may operate based on an operating system stored in the second memory 1932, such as Windows ServerTM, Mac OS XTM, UnixTM, LinuxTM, FreeBSDTM or the like.
  • the present disclosure also provides a computer-readable storage medium having computer program instructions stored thereon, and the program instructions, when executed by a processor, implement the steps of the vehicle positioning method provided by the present disclosure.
  • a computer program product includes a computer program executable by a programmable device.
  • the computer program has a code portion for executing the above-mentioned vehicle positioning method when executed by the programmable device.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

The present disclosure relates to a vehicle localization method and apparatus, and a vehicle. The method comprises: after a vehicle is powered on, acquiring first localization information of the vehicle and second localization information stored before the vehicle is powered off last time; determining a target localization mode from different localization modes according to a size relationship between a deviation value between the first localization information and the second localization information and a preset deviation threshold value; and determining target localization information of the vehicle according to the target localization mode. In the present disclosure, a deviation value between first localization information acquired after a vehicle is powered on and second localization information stored before the vehicle is powered off serves as a basis for selecting a target localization mode, different localization modes are selected when the sizes of vehicle localization deviations are different, such that the problem of a localization deviation being relatively large after a vehicle is moved when an automatic parking system of the vehicle is not started can be effectively solved, and the localization accuracy of the vehicle in an occlusion scenario is thus improved.

Description

车辆定位方法、装置及车辆Vehicle positioning method, device and vehicle 技术领域Technical Field
本公开涉及车辆控制技术领域,具体地,涉及一种车辆定位方法、装置及车辆。The present disclosure relates to the field of vehicle control technology, and in particular, to a vehicle positioning method, device and vehicle.
背景技术Background technique
自动泊车系统是一种帮助驾驶员识别可用车位,并将车辆自动驾驶到可用车位中的驾驶辅助系统。自动泊车采用车上的视觉传感器或超声波雷达感知周边环境,在中央处理器中规划泊入方法和路径,并控制车辆自动行驶到车位中。The automatic parking system is a driving assistance system that helps the driver identify available parking spaces and automatically drives the vehicle into the available parking spaces. Automatic parking uses the vehicle's visual sensors or ultrasonic radar to perceive the surrounding environment, plans the parking method and path in the central processor, and controls the vehicle to automatically drive into the parking space.
相关技术中,在无全球导航卫星系统(Global Navigation Satellite System,GNSS)和RTK(Real-time kinematic,实时动态)融合定位的情况下,车辆的自动泊车系统在停车场的定位依靠车辆自带的传感器,一般采用激光雷达进行SLAM(simultaneous localization and mapping,即时定位与地图构建)建立停车场地图,并根据车辆泊入停车场时记录的位置,并以此位置作为车辆在上电后行驶前在SLAM地图中的初始位置。而在车辆泊车下电后,若在自动泊车系统未启动的情况下移动车辆,自动泊车系统在下电前泊入时记录的车辆位置和启动车辆的实际位置不一致,导致车辆定位偏差较大。In the related technology, in the absence of fusion positioning of the Global Navigation Satellite System (GNSS) and RTK (Real-time kinematic), the positioning of the vehicle's automatic parking system in the parking lot relies on the vehicle's own sensors, generally using laser radar for SLAM (simultaneous localization and mapping) to build a parking lot map, and based on the position recorded when the vehicle is parked in the parking lot, this position is used as the initial position of the vehicle in the SLAM map before the vehicle is powered on and driven. After the vehicle is parked and powered off, if the vehicle is moved without the automatic parking system started, the vehicle position recorded by the automatic parking system when it was parked before the power was turned off is inconsistent with the actual position of the vehicle when it was started, resulting in a large deviation in the vehicle positioning.
发明内容Summary of the invention
本公开的目的是提供一种车辆定位方法、装置及车辆,以解决在自动泊车系统未启动的情况下移动车辆,导致车辆定位偏差较大的问题。The purpose of the present disclosure is to provide a vehicle positioning method, device and vehicle to solve the problem of large vehicle positioning deviation caused by moving the vehicle when the automatic parking system is not activated.
为了实现上述目的,本公开提供一种车辆定位方法,所述方法包括:In order to achieve the above object, the present disclosure provides a vehicle positioning method, the method comprising:
在车辆上电后,获取所述车辆的第一定位信息以及在上次下电前所存储的第二定位信息;After the vehicle is powered on, obtaining the first positioning information of the vehicle and the second positioning information stored before the vehicle was powered off last time;
根据所述第一定位信息和所述第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式;Determine a target positioning method from different positioning methods according to a magnitude relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold;
根据目标定位方式,确定所述车辆的目标定位信息。According to the target positioning method, the target positioning information of the vehicle is determined.
可选地,根据所述第一定位信息和所述第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式的步骤,包括:Optionally, the step of determining a target positioning mode from different positioning modes according to a size relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold value includes:
在所述偏差值小于所述偏差阈值的情况下,确定所述目标定位方式为第一定位方式,所述第一定位方式是将所述第一定位信息确定为所述目标定位信息的方式。When the deviation value is less than the deviation threshold, the target positioning mode is determined to be a first positioning mode, where the first positioning mode is a mode of determining the first positioning information as the target positioning information.
可选地,根据所述第一定位信息和所述第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式的步骤,包括:Optionally, the step of determining a target positioning mode from different positioning modes according to a size relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold value includes:
在所述偏差值大于所述偏差阈值的情况下,确定所述目标定位方式为第二定位方式,所述第二定位方式是根据车辆周围的环境图像以及所述第一定位信息,确定所述目标定位信息的方式。When the deviation value is greater than the deviation threshold, the target positioning method is determined to be a second positioning method, where the second positioning method is a method of determining the target positioning information based on an environmental image around the vehicle and the first positioning information.
可选地,根据目标定位方式,确定所述车辆的目标定位信息的步骤,包括:Optionally, the step of determining the target positioning information of the vehicle according to the target positioning method includes:
在确定所述目标定位方式为所述第二定位方式的情况下,获取所述环境图像;When it is determined that the target positioning mode is the second positioning mode, acquiring the environment image;
根据所述环境图像,得到车辆所在车位的编号信息;According to the environment image, obtaining the number information of the parking space where the vehicle is located;
根据所述编号信息以及所述第一定位信息,得到所述目标定位信息。The target positioning information is obtained according to the numbering information and the first positioning information.
可选地,根据所述编号信息以及所述第一定位信息,得到所述目标定位信息的步骤,包括:Optionally, the step of obtaining the target positioning information according to the numbering information and the first positioning information includes:
根据所述第一定位信息,获得车辆的实时点云信息;Obtaining real-time point cloud information of the vehicle according to the first positioning information;
根据所述编号信息,确定车辆所在车位的车位点云信息;Determine the parking space cloud information of the parking space where the vehicle is located according to the number information;
采用ICP算法对所述实时点云信息以及所述车位点云信息进行配准,获得所述目标定位信息。The ICP algorithm is used to align the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information.
可选地,采用ICP算法对所述实时点云信息以及所述车位点云信息进行配准,获得所述目标定位信息的步骤,包括:Optionally, the step of registering the real-time point cloud information and the parking spot point cloud information using an ICP algorithm to obtain the target positioning information includes:
根据所述车位点云信息,初始化所述实时点云信息的特征矩阵的值;Initializing the value of the feature matrix of the real-time point cloud information according to the parking spot cloud information;
从所述车位点云信息中获取与所述实时点云信息之间满足距离条件的目标点;Acquire a target point that satisfies a distance condition with respect to the real-time point cloud information from the parking spot cloud information;
根据所述目标点以及所述实时点云信息中与所述目标点所对应的点之间的距离误差,采用最小二乘法对所述特征矩阵的值进行迭代计算,得到目标特征矩阵;According to the distance error between the target point and the point corresponding to the target point in the real-time point cloud information, the value of the feature matrix is iteratively calculated using the least square method to obtain a target feature matrix;
根据所述目标特征矩阵,获得所述目标定位信息。The target positioning information is obtained according to the target feature matrix.
可选地,根据所述目标特征矩阵,获得所述目标定位信息的步骤,包括:Optionally, the step of obtaining the target positioning information according to the target feature matrix includes:
采用SVD方法对所述目标特征矩阵求解,得到目标旋转矩阵;The target feature matrix is solved by using the SVD method to obtain a target rotation matrix;
根据所述目标旋转矩阵,得到所述目标定位信息。The target positioning information is obtained according to the target rotation matrix.
可选地,在根据目标定位方式,确定所述车辆的目标定位信息的步骤之后,所述方法还包括:Optionally, after the step of determining the target positioning information of the vehicle according to the target positioning mode, the method further includes:
根据所述目标定位信息,更新车辆在地图中的实际位置;According to the target positioning information, updating the actual position of the vehicle in the map;
根据所述实际位置以及用户所输入的目标位置,得到车辆的行驶路径。The vehicle's driving path is obtained based on the actual position and the target position input by the user.
为了实现上述目的,本公开还提供一种车辆定位装置,所述装置包括:In order to achieve the above object, the present disclosure also provides a vehicle positioning device, the device comprising:
获取模块,用于在车辆上电后,获取所述车辆的第一定位信息以及在上次下电前所存储的第二定位信息;An acquisition module, used for acquiring the first positioning information of the vehicle and the second positioning information stored before the vehicle was powered off last time after the vehicle was powered on;
第一确定模块,用于根据所述第一定位信息和所述第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式;A first determination module, configured to determine a target positioning mode from different positioning modes according to a magnitude relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold;
第二确定模块,用于根据目标定位方式,确定所述车辆的目标定位信息。The second determination module is used to determine the target positioning information of the vehicle according to the target positioning method.
为了实现上述目的,本公开还提供一种车辆,所述车辆包括:In order to achieve the above object, the present disclosure further provides a vehicle, the vehicle comprising:
处理器和存储器,所述存储器存储有能够被所述处理器执行的机器可执行指令,所述处理器用于执行机器可执行指令,以实现上述车辆定位方法。A processor and a memory, wherein the memory stores machine executable instructions that can be executed by the processor, and the processor is used to execute the machine executable instructions to implement the above-mentioned vehicle positioning method.
本公开实施例根据车辆上电后获取的第一定位信息以及车辆在上次下电前所存储的第二定位信息之间的偏差值与预设的偏差阈值的大小关系,确定目标定位方式,并根据目标定位方式确定目标定位信息,相比于现有技术中将车辆在下电前所存储的定位信息直接作为车辆行驶的初始位置的方法,本公开根据车辆在上电后获取的第一定位信息和车辆下电前所存储的第二定位信息之间的偏差值作为选择目标定位方式的依据,在车辆定位偏差大小不同的情况下选择不同的定位方式,如此,根据车辆在上电后和上次下电前的定位信息之间的差距大小相对比后确定的定位方式,可以有效解决车辆自动泊车系统未启动的情况下移动车辆后定位偏差较大的问题,并提高车辆在遮挡场景下的定位准确性。The embodiment of the present disclosure determines a target positioning method based on a relationship between a deviation value between first positioning information obtained after the vehicle is powered on and second positioning information stored before the vehicle was last powered off and a preset deviation threshold, and determines the target positioning information based on the target positioning method. Compared with the method in the prior art that directly uses the positioning information stored before the vehicle is powered off as the initial position of the vehicle, the present disclosure uses the deviation value between the first positioning information obtained after the vehicle is powered on and the second positioning information stored before the vehicle is powered off as the basis for selecting the target positioning method, and selects different positioning methods when the vehicle positioning deviation size is different. In this way, the positioning method determined after comparing the difference size between the positioning information of the vehicle after power-on and before power-off can effectively solve the problem of large positioning deviation after moving the vehicle when the automatic parking system of the vehicle is not started, and improves the positioning accuracy of the vehicle in occluded scenarios.
本公开的其他特征和优点将在随后的具体实施方式部分予以详细说明。Other features and advantages of the present disclosure will be described in detail in the following detailed description.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
附图是用来提供对本公开的进一步理解,并且构成说明书的一部分,与下面的具体实施方式一起用于解释本公开,但并不构成对本公开的限制。在附图中:The accompanying drawings are used to provide a further understanding of the present disclosure and constitute a part of the specification. Together with the following specific embodiments, they are used to explain the present disclosure but do not constitute a limitation of the present disclosure. In the accompanying drawings:
图1是根据一示例性实施例示出的一种车辆定位方法的流程图。Fig. 1 is a flow chart showing a vehicle positioning method according to an exemplary embodiment.
图2是根据一示例性实施例示出的一种车辆定位装置的框图。Fig. 2 is a block diagram of a vehicle positioning device according to an exemplary embodiment.
图3是根据一示例性实施例示出的一种车辆的功能框图示意图。Fig. 3 is a schematic diagram of a functional block diagram of a vehicle according to an exemplary embodiment.
图4是根据一示例性实施例示出的一种用于车辆定位方法的装置的框图。Fig. 4 is a block diagram showing a device for a vehicle positioning method according to an exemplary embodiment.
具体实施方式Detailed ways
这里将详细地对示例性实施例进行说明,其示例表示在附图中。下面的描述涉及附图时,除非另有表示,不同附图中的相同数字表示相同或相似的要素。以下示例性实施例中 所描述的实施方式并不代表与本公开相一致的所有实施方式。相反,它们仅是与如所附权利要求书中所详述的、本公开的一些方面相一致的装置和方法的例子。Exemplary embodiments will be described in detail herein, examples of which are shown in the accompanying drawings. When the following description refers to the drawings, the same numbers in different drawings represent the same or similar elements unless otherwise indicated. The embodiments described in the following exemplary embodiments do not represent all embodiments consistent with the present disclosure. Instead, they are merely examples of devices and methods consistent with some aspects of the present disclosure as detailed in the appended claims.
相关技术中,SLAM主要的作用是让机器人在未知的环境中,完成定位(Localization)、建图(Mapping)和路径规划(Navigation)。SLAM技术被广泛运用于机器人、无人机、无人驾驶、AR、VR等领域,依靠传感器可实现机器的自主定位、建图、路径规划等功能。车辆的传感器可以包括激光雷达、毫米波雷达、超声雷达以及视觉传感器。Among related technologies, the main function of SLAM is to enable robots to complete localization, mapping, and navigation in unknown environments. SLAM technology is widely used in robots, drones, unmanned driving, AR, VR and other fields. Sensors can be used to achieve autonomous positioning, mapping, and path planning of machines. Vehicle sensors can include lidar, millimeter-wave radar, ultrasonic radar, and visual sensors.
车辆在上电启动时一般基于组合导航实现车辆定位,组合导航是指综合各种导航设备,由监视器和计算机进行控制的导航系统。大多数组合导航系统以惯导系统为主,其原因主要是由于惯性导航能够提供比较多的导航参数,还能够提供全姿态信息参数。而车辆在有遮挡的停车场泊车停靠时,由于组合导航的搜星性能较差,无法提供信号遮挡时车辆的精准的定位位置。而通过激光SLAM技术对车辆所在环境进行定位的情况下,由于SLAM算法的鲁棒性较差,导致车辆定位偏差较大。When the vehicle is powered on and started, it is generally positioned based on integrated navigation. Integrated navigation refers to a navigation system that integrates various navigation devices and is controlled by a monitor and a computer. Most integrated navigation systems are based on inertial navigation systems. The main reason is that inertial navigation can provide more navigation parameters and full attitude information parameters. However, when the vehicle is parked in a covered parking lot, the combined navigation has poor satellite search performance and cannot provide accurate positioning of the vehicle when the signal is blocked. When the laser SLAM technology is used to locate the environment in which the vehicle is located, the poor robustness of the SLAM algorithm leads to a large deviation in vehicle positioning.
另外,针对车辆在泊入停车位并下电后,由于驾驶员可能会在泊车系统未正常启动的情况下完成车位更换,自动泊车系统在下电前泊入时记录的车辆位置和启动车辆的实际位置不一致,导致车辆定位偏差较大。In addition, after the vehicle is parked in a parking space and the power is turned off, the driver may complete the parking space change without the parking system being started normally. The vehicle position recorded by the automatic parking system when parking before power is turned off is inconsistent with the actual position of the started vehicle, resulting in a large deviation in vehicle positioning.
基于上述问题,本公开实施例提供一种解决上述问题的构思,基于在上电后获取的第一定位信息以及车辆在上次下电前存储的第二定位信息之间的偏差值以及预设的偏差阈值,从不同的定位方式确定出目标定位方式,从而获得目标定位信息。Based on the above problems, an embodiment of the present disclosure provides a concept for solving the above problems. Based on the deviation value between the first positioning information obtained after power-on and the second positioning information stored before the vehicle was last powered off, as well as a preset deviation threshold, a target positioning method is determined from different positioning methods, thereby obtaining target positioning information.
下面结合附图对本公开的实施例进行具体说明。The embodiments of the present disclosure are described in detail below with reference to the accompanying drawings.
请参阅图1,图1是根据一示例性实施例示出的一种车辆定位方法的流程图,如图1所示,车辆定位方法包括:Please refer to FIG. 1 , which is a flow chart of a vehicle positioning method according to an exemplary embodiment. As shown in FIG. 1 , the vehicle positioning method includes:
S101、在车辆上电后,获取车辆的第一定位信息以及在上次下电前所存储的第二定位信息。S101. After a vehicle is powered on, first positioning information of the vehicle and second positioning information stored before the vehicle was powered off last time are obtained.
在具体的实施过程中,第一定位信息是车辆在上电后重新定位得到的,第二定位信息是车辆在上次行驶后下电前存储的,第一定位信息和第二定位信息均是根据车辆上的传感器进行定位,并经由SLAM构建的地图显示在车辆的车载娱乐控制系统(HUT)上。其中,车辆的传感器可以包括惯性测量单元(inertial measurement unit,IMU)、激光雷达、毫米波雷达、超声雷达以及摄像装置。In the specific implementation process, the first positioning information is obtained by repositioning the vehicle after power-on, and the second positioning information is stored before the vehicle is powered off after the last trip. Both the first positioning information and the second positioning information are positioned according to the sensors on the vehicle, and the map constructed by SLAM is displayed on the vehicle's head-mounted entertainment control system (HUT). Among them, the vehicle's sensors may include inertial measurement units (IMU), laser radars, millimeter-wave radars, ultrasonic radars, and cameras.
在车辆泊车时,驾驶员打开车辆的自动泊车系统,自动泊车系统在车辆完成泊车后,会记录车辆在下电前的第二定位信息并存储至整车控制器中,以在车辆上电后确定车辆的实际定位位置。When parking the vehicle, the driver turns on the vehicle's automatic parking system. After the vehicle completes parking, the automatic parking system will record the vehicle's second positioning information before power is turned off and store it in the vehicle controller to determine the vehicle's actual positioning position after the vehicle is powered on.
S102、根据第一定位信息和第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式。S102: Determine a target positioning method from different positioning methods according to a deviation value between the first positioning information and the second positioning information and a size relationship between a preset deviation threshold.
在具体的实施过程中,偏差值是基于第一定位信息和第二定位信息得到的,而预设的偏差阈值可以根据车辆自身尺寸以及传感器的误差进行确定。一般情况下,车辆自身尺寸越大和传感器误差越大,偏差值越大,反之偏差值越小。现有的定位方式,例如,直接根据本次上电后车辆通过传感器和组合导航重新定位后的定位信息确定本次行驶的初始位置,此种情况下,在车辆下电前可以不存储下电前车辆的定位信息。即,现有的定位方式一般是根据车辆在上次下电前的存储的定位信息确定车辆本次行驶的初始位置,或者根据车辆在上电启动后重新获取的定位信息确定车辆本次行驶的初始位置。In the specific implementation process, the deviation value is obtained based on the first positioning information and the second positioning information, and the preset deviation threshold can be determined according to the size of the vehicle itself and the error of the sensor. In general, the larger the size of the vehicle itself and the larger the sensor error, the larger the deviation value, and vice versa. The existing positioning method, for example, directly determines the initial position of this trip based on the positioning information after the vehicle is re-positioned by the sensor and combined navigation after this power-on. In this case, the positioning information of the vehicle before power-off may not be stored before the vehicle is powered off. That is, the existing positioning method generally determines the initial position of the vehicle for this trip based on the stored positioning information before the last power-off, or determines the initial position of the vehicle for this trip based on the positioning information re-acquired after the vehicle is powered on.
目标定位方式是从不同的定位方式中确定的定位方式。一般情况下,定位方式可以包括多个,例如,在车辆传感器包括激光雷达或摄像头的情况下,可以基于SLAM算法得到目标定位信息。在车辆传感器包括组合导航的情况下,可以基于航迹递推方法得到目标定位信息。The target positioning method is a positioning method determined from different positioning methods. Generally, the positioning methods may include multiple methods. For example, when the vehicle sensor includes a laser radar or a camera, the target positioning information may be obtained based on a SLAM algorithm. When the vehicle sensor includes an integrated navigation, the target positioning information may be obtained based on a track recursion method.
在一种实施例中,还可以基于多种车辆传感器采集的数据实现车辆定位,由此可以避免因单一传感器失效而无法进行自身定位的情况,提高了定位结果的鲁棒性。In one embodiment, vehicle positioning can also be achieved based on data collected by multiple vehicle sensors, thereby avoiding the situation where the vehicle cannot perform self-positioning due to failure of a single sensor, thereby improving the robustness of the positioning result.
在本公开实施例中,定位方式具体可以是根据车辆上电后确定的第一定位信息,确定车辆的初始位置,也可以是根据车辆当前周围的环境图像以及下电前所储存的定位信息,确定车辆的初始位置。In the embodiment of the present disclosure, the positioning method can specifically determine the initial position of the vehicle based on the first positioning information determined after the vehicle is powered on, or it can determine the initial position of the vehicle based on the environmental image of the current surroundings of the vehicle and the positioning information stored before power-off.
S103、根据目标定位方式,确定车辆的目标定位信息。S103: Determine the target positioning information of the vehicle according to the target positioning method.
在具体的实施过程中,目标定位信息用于确定车辆的上电后的初始位置,在确定出目标定位方式后,可以根据目标定位方式得到车辆的目标定位信息。其中,在第一定位信息和第二定位信息之间的偏差值小于预设的偏差阈值的情况下,将第一定位信息直接确定为目标定位信息;或者,在第一定位信息和第二定位信息之间的偏差值大于预设的偏差阈值的情况下,根据车辆环境图像识别车辆当前所在车位的编号信息,并根据编号信息和第一定位信息进行匹配运算,得到更新后的目标定位信息。In the specific implementation process, the target positioning information is used to determine the initial position of the vehicle after power-on. After the target positioning method is determined, the target positioning information of the vehicle can be obtained according to the target positioning method. Wherein, when the deviation value between the first positioning information and the second positioning information is less than the preset deviation threshold, the first positioning information is directly determined as the target positioning information; or, when the deviation value between the first positioning information and the second positioning information is greater than the preset deviation threshold, the number information of the parking space where the vehicle is currently located is identified according to the vehicle environment image, and a matching operation is performed according to the number information and the first positioning information to obtain the updated target positioning information.
本公开实施例根据车辆上电后获取的第一定位信息以及车辆在上次下电前所存储的第二定位信息之间的偏差值与预设的偏差阈值的大小关系,确定目标定位方式,并根据目标定位方式确定目标定位信息,相比于现有技术中将车辆在下电前所存储的定位信息直接作为车辆行驶的初始位置的方法,本公开根据车辆在上电后获取的第一定位信息和车辆下电前所存储的第二定位信息之间的偏差值作为选择目标定位方式的依据,在车辆定位偏差大小不同的情况下选择不同的定位方式,如此,根据车辆在上电后和上次下电前的定位信息之间的差距大小相对比后确定的定位方式,可以有效解决车辆自动泊车系统未启动的情况下移动车辆后定位偏差较大的问题,并提高车辆在遮挡场景下的定位准确性。The embodiment of the present disclosure determines a target positioning method based on a relationship between a deviation value between first positioning information obtained after the vehicle is powered on and second positioning information stored before the vehicle was last powered off and a preset deviation threshold, and determines the target positioning information based on the target positioning method. Compared with the method in the prior art that directly uses the positioning information stored before the vehicle is powered off as the initial position of the vehicle, the present disclosure uses the deviation value between the first positioning information obtained after the vehicle is powered on and the second positioning information stored before the vehicle is powered off as the basis for selecting the target positioning method, and selects different positioning methods when the vehicle positioning deviation size is different. In this way, the positioning method determined after comparing the difference size between the positioning information of the vehicle after power-on and before power-off can effectively solve the problem of large positioning deviation after moving the vehicle when the automatic parking system of the vehicle is not started, and improves the positioning accuracy of the vehicle in occluded scenarios.
在一些实施例中,根据第一定位信息和第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式的步骤,包括:In some embodiments, the step of determining the target positioning mode from different positioning modes according to the deviation value between the first positioning information and the second positioning information and the size relationship between the preset deviation threshold value includes:
在偏差值小于偏差阈值的情况下,确定目标定位方式为第一定位方式,第一定位方式是将第一定位信息确定为目标定位信息的方式。When the deviation value is less than the deviation threshold, the target positioning mode is determined to be the first positioning mode, where the first positioning mode is a mode of determining the first positioning information as the target positioning information.
在具体的实施过程中,在偏差值小于偏差阈值的情况下,偏差值处于定位偏差范围内,确定车辆在自动泊车系统关闭后没有移动或者没有出现位置移动距离过大的情况,可以将本次上电后车辆获取的第一定位信息作为当前车辆的目标定位信息。During the specific implementation process, when the deviation value is less than the deviation threshold, the deviation value is within the positioning deviation range, and it is determined that the vehicle has not moved after the automatic parking system is turned off or the position has not moved too far. The first positioning information obtained by the vehicle after this power-on can be used as the target positioning information of the current vehicle.
在一些实施例中,根据第一定位信息和第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式的步骤,包括:In some embodiments, the step of determining the target positioning mode from different positioning modes according to the deviation value between the first positioning information and the second positioning information and the size relationship between the preset deviation threshold value includes:
在偏差值大于偏差阈值的情况下,确定目标定位方式为第二定位方式,第二定位方式是根据车辆周围的环境图像以及第一定位信息,确定目标定位信息的方式。When the deviation value is greater than the deviation threshold, the target positioning method is determined to be the second positioning method, which is a method of determining the target positioning information based on the environmental image around the vehicle and the first positioning information.
在具体的实施过程中,在偏差值大于偏差阈值的情况下,确定车辆在泊车系统关闭后经过了较大的位移或者定位系统出现较大偏差,由于激光SLAM算法的鲁棒性较差,受停车场遮挡场景的影响,定位性能较差,直接采用第一定位信息作为目标定位信息会使车辆定位偏差较大,需要重新定位。此时可以采用车辆的视觉传感器获取车辆周围的环境图像,一般情况下,视觉传感器为车辆自带的摄像装置,根据环境图像以及车辆在上电后重新定位得到的第一定位信息,匹配得到车辆的目标定位信息。In the specific implementation process, when the deviation value is greater than the deviation threshold, it is determined that the vehicle has undergone a large displacement or a large deviation in the positioning system after the parking system is turned off. Due to the poor robustness of the laser SLAM algorithm and the influence of the parking lot occlusion scene, the positioning performance is poor. Directly using the first positioning information as the target positioning information will cause a large deviation in the vehicle positioning and require repositioning. At this time, the vehicle's visual sensor can be used to obtain the environmental image around the vehicle. Generally, the visual sensor is a camera device that comes with the vehicle. According to the environmental image and the first positioning information obtained by repositioning the vehicle after power-on, the target positioning information of the vehicle is matched.
在一些实施例中,根据目标定位方式,确定车辆的目标定位信息的步骤,包括:In some embodiments, the step of determining the target positioning information of the vehicle according to the target positioning method includes:
在确定目标定位方式为第二定位方式的情况下,获取环境图像;When it is determined that the target positioning mode is the second positioning mode, acquiring an environment image;
根据环境图像,得到车辆所在车位的编号信息;According to the environment image, the number information of the parking space where the vehicle is located is obtained;
根据编号信息以及第一定位信息,得到目标定位信息。The target positioning information is obtained according to the numbering information and the first positioning information.
在具体的实施过程中,在获取到环境图像后,根据图像识别算法,可以识别出环境图像中的车位编号信息,由于在车辆上次下电前已根据SLAM构建了停车场的地图,因此可以在摄像装置识别到车辆当前所在车位的编号信息的情况下,将该编号信息匹配定位至所 构建的地图中,以得到目标定位信息。In the specific implementation process, after acquiring the environmental image, the parking space number information in the environmental image can be identified according to the image recognition algorithm. Since a map of the parking lot has been constructed according to SLAM before the vehicle was last powered off, when the camera device recognizes the number information of the parking space where the vehicle is currently located, the number information can be matched and located in the constructed map to obtain the target positioning information.
需要说明的是,图像识别算法在此处不做具体限定,例如,可以是基于深度神经网络的图像识别算法、基于分类器的图像识别算法以及支持向量机(SVM)的图像识别算法。It should be noted that the image recognition algorithm is not specifically limited here. For example, it can be an image recognition algorithm based on a deep neural network, an image recognition algorithm based on a classifier, and an image recognition algorithm based on a support vector machine (SVM).
在一些实施例中,根据编号信息以及第一定位信息,得到目标定位信息的步骤,包括:In some embodiments, the step of obtaining target positioning information according to the numbering information and the first positioning information includes:
根据第一定位信息,获得车辆的实时点云信息;Obtaining real-time point cloud information of the vehicle according to the first positioning information;
根据编号信息,确定车辆所在车位的车位点云信息;According to the number information, determine the parking spot cloud information of the parking space where the vehicle is located;
采用ICP算法对实时点云信息以及车位点云信息进行配准,获得目标定位信息。The ICP algorithm is used to align the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information.
在具体的实施过程中,实时点云信息是根据第一定位信息获取的用于表征车辆位置的点集的坐标,车位点云信息是用于表征车辆所在车位位置的点集的坐标。ICP算法是基于数据配准法,利用最近点搜索法,从而解决基于自由形态曲面的一种算法。In the specific implementation process, the real-time point cloud information is the coordinates of the point set used to characterize the vehicle position obtained according to the first positioning information, and the parking point cloud information is the coordinates of the point set used to characterize the parking space position of the vehicle. The ICP algorithm is based on the data registration method and uses the nearest point search method to solve an algorithm based on free-form surfaces.
在一些实施例中,采用ICP算法对实时点云信息以及车位点云信息进行配准,获得目标定位信息的步骤,包括:In some embodiments, the step of using the ICP algorithm to register the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information includes:
根据车位点云信息,初始化实时点云信息的特征矩阵的值;Initialize the value of the feature matrix of the real-time point cloud information according to the parking point cloud information;
从车位点云信息中获取与实时点云信息之间满足距离条件的目标点;Obtain a target point that meets the distance condition with the real-time point cloud information from the parking spot cloud information;
根据目标点以及实时点云信息中与目标点所对应的点之间的距离误差,采用最小二乘法对特征矩阵的值进行迭代计算,得到目标特征矩阵;According to the distance error between the target point and the point corresponding to the target point in the real-time point cloud information, the value of the feature matrix is iteratively calculated using the least square method to obtain the target feature matrix;
根据目标特征矩阵,获得目标定位信息。According to the target feature matrix, the target positioning information is obtained.
在具体的实施过程中,初始化实时点云的特征矩阵的值是以车位点云信息所在的坐标系为基础,给实时点云信息中的每个坐标点赋值。距离条件可以是车位点云信息中获取与实时点云信息之间的相匹配的点的距离小于预设的距离阈值。在初始化实时点云信息的特征矩阵的值的情况下,实时点云信息和车位点云信息中的点匹配,实时点云信息和车位点云信息中的每个点均为一个向量,并根据实时点云信息和车位点云信息之间相匹配的点的距离,采用最小二乘法迭代更新特征矩阵的值,以使误差函数最小,最终得到优化后的目标特征矩阵。In the specific implementation process, the value of the feature matrix of the real-time point cloud is initialized based on the coordinate system where the parking point cloud information is located, and each coordinate point in the real-time point cloud information is assigned a value. The distance condition can be that the distance between the matching point obtained in the parking point cloud information and the real-time point cloud information is less than a preset distance threshold. In the case of initializing the value of the feature matrix of the real-time point cloud information, the points in the real-time point cloud information and the parking point cloud information are matched, and each point in the real-time point cloud information and the parking point cloud information is a vector. According to the distance between the matching points between the real-time point cloud information and the parking point cloud information, the value of the feature matrix is iteratively updated using the least squares method to minimize the error function, and finally the optimized target feature matrix is obtained.
具体的,ICP算法步骤可以为:Specifically, the ICP algorithm steps may be:
(1)在实时点云信息P中取点集p i∈P; (1) Take a point set p i ∈ P from the real-time point cloud information P;
(2)找出车位点云信息Q中的对应点集q i∈Q,使得||q i-p i||=min; (2) Find the corresponding point set q i ∈ Q in the parking spot cloud information Q, so that ||q i -p i || = min;
(3)计算特征矩阵,使得误差函数最小,特征矩阵包括旋转矩阵R和平移矩阵t;(3) Calculate the characteristic matrix to minimize the error function. The characteristic matrix includes the rotation matrix R and the translation matrix t;
(4)对p i使用第(3)步得到的旋转矩阵R和平移矩阵t进行旋转和平移变换,得到新的对应点集p i’={p i’=Rp i+t,p i∈PP; (4) Use the rotation matrix R and translation matrix t obtained in step (3) to rotate and translate p i to obtain a new corresponding point set p i ′={p i ′=Rp i +t, p i ∈PP;
(5)根据
Figure PCTCN2022133346-appb-000001
计算p i’与对应点集q i的平均距离;
(5) Based on
Figure PCTCN2022133346-appb-000001
Calculate the average distance between p i ' and the corresponding point set q i ;
(6)如果d小于某一给定的阈值或者大于预设的最大迭代次数,则停止迭代计算。否则返回第(2)步,直到满足收敛条件为止。(6) If d is less than a given threshold or greater than the preset maximum number of iterations, the iterative calculation is stopped. Otherwise, return to step (2) until the convergence condition is met.
在一些实施例中,根据目标特征矩阵,获得目标定位信息的步骤,包括:In some embodiments, the step of obtaining target positioning information according to the target feature matrix includes:
采用SVD方法对目标特征矩阵求解,得到目标旋转矩阵;The SVD method is used to solve the target feature matrix and obtain the target rotation matrix;
根据目标旋转矩阵,得到目标定位信息。According to the target rotation matrix, the target positioning information is obtained.
在具体的实施过程中,一般情况下对目标特征矩阵求解的方法包括SVD方法以及非线性优化方法,在本公开采用SVD算法求解,其具体步骤包括:In the specific implementation process, the methods for solving the target feature matrix generally include the SVD method and the nonlinear optimization method. In the present disclosure, the SVD algorithm is used for solving, and the specific steps include:
①计算实时点云信息和车位点云信息中的匹配点的质心,得到去质心的点集;① Calculate the centroid of the matching points in the real-time point cloud information and the parking spot cloud information to obtain the point set without the centroid;
②计算3x3矩阵H,H=XY T,X和Y分别为去质心的实时点云信息和车位点云信息的特征矩阵。 ② Calculate the 3x3 matrix H, H = XY T , where X and Y are the feature matrices of the real-time point cloud information without centroid and the parking spot cloud information respectively.
③对H进行SVD分解H=U∑V T,得到目标旋转矩阵R *=VU T③ Perform SVD decomposition on H to obtain H = U∑V T and obtain the target rotation matrix R * = VU T .
在一些实施例中,在根据目标定位方式,确定车辆的目标定位信息的步骤之后,方法还包括:In some embodiments, after the step of determining the target positioning information of the vehicle according to the target positioning method, the method further includes:
根据目标定位信息,更新车辆在地图中的实际位置;Update the actual position of the vehicle in the map based on the target positioning information;
根据实际位置以及用户所输入的目标位置,得到车辆的行驶路径。The vehicle's driving path is obtained based on the actual position and the target position input by the user.
在具体的实施过程中,在获得目标定位信息后,在车辆的SLAM地图中更新车辆当前所处的实际位置,整车控制器可以根据实际位置和用户输入的目标位置,计算得出车辆的行驶路径。In the specific implementation process, after obtaining the target positioning information, the actual position of the vehicle is updated in the vehicle's SLAM map, and the vehicle controller can calculate the vehicle's driving path based on the actual position and the target position input by the user.
请参阅图2,图2是根据一示例性实施例示出的一种车辆定位装置的框图,如图2所示,车辆定位装置500包括:Please refer to FIG. 2 , which is a block diagram of a vehicle positioning device according to an exemplary embodiment. As shown in FIG. 2 , the vehicle positioning device 500 includes:
获取模块520,用于在车辆上电后,获取车辆的第一定位信息以及在上次下电前所存储的第二定位信息;The acquisition module 520 is used to acquire the first positioning information of the vehicle and the second positioning information stored before the vehicle was powered off last time after the vehicle is powered on;
第一确定模块530,用于根据第一定位信息和第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式;A first determination module 530 is used to determine a target positioning mode from different positioning modes according to a deviation value between the first positioning information and the second positioning information and a size relationship between a preset deviation threshold;
第二确定模块540,用于根据目标定位方式,确定车辆的目标定位信息。The second determination module 540 is used to determine the target positioning information of the vehicle according to the target positioning method.
在一些实施例中,第一确定模块530包括:In some embodiments, the first determination module 530 includes:
第一确定子模块,用于在偏差值小于偏差阈值的情况下,确定目标定位方式为第一定位方式,第一定位方式是将第一定位信息确定为目标定位信息的方式。The first determination submodule is used to determine that the target positioning mode is a first positioning mode when the deviation value is less than the deviation threshold. The first positioning mode is a mode of determining the first positioning information as the target positioning information.
在一些实施例中,第一确定模块530包括:In some embodiments, the first determination module 530 includes:
第二确定子模块,用于在偏差值大于偏差阈值的情况下,确定目标定位方式为第二定位方式,第二定位方式是根据车辆周围的环境图像以及第一定位信息,确定目标定位信息的方式。The second determination submodule is used to determine that the target positioning method is a second positioning method when the deviation value is greater than the deviation threshold. The second positioning method is a method of determining the target positioning information based on the environmental image around the vehicle and the first positioning information.
在一些实施例中,第二确定模块540包括:In some embodiments, the second determination module 540 includes:
获取子模块,用于在确定目标定位方式为第二定位方式的情况下,获取环境图像;An acquisition submodule, used for acquiring an environment image when it is determined that the target positioning mode is the second positioning mode;
第一得到子模块,用于根据环境图像,得到车辆所在车位的编号信息;The first obtaining submodule is used to obtain the number information of the parking space where the vehicle is located according to the environment image;
第二得到子模块,用于根据编号信息以及第一定位信息,得到目标定位信息。The second obtaining submodule is used to obtain target positioning information according to the numbering information and the first positioning information.
在一些实施例中,第二得到子模块具体用于:In some embodiments, the second obtaining submodule is specifically used for:
根据第一定位信息,获得车辆的实时点云信息;Obtaining real-time point cloud information of the vehicle according to the first positioning information;
根据编号信息,确定车辆所在车位的车位点云信息;According to the number information, determine the parking spot cloud information of the parking space where the vehicle is located;
采用ICP算法对实时点云信息以及车位点云信息进行配准,获得目标定位信息。The ICP algorithm is used to align the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information.
在一些实施例中,第二得到子模块具体用于:In some embodiments, the second obtaining submodule is specifically used for:
根据车位点云信息,初始化实时点云信息的特征矩阵的值;Initialize the value of the feature matrix of the real-time point cloud information according to the parking point cloud information;
从车位点云信息中获取与实时点云信息之间满足距离条件的目标点;Obtain a target point that meets the distance condition with the real-time point cloud information from the parking spot cloud information;
根据目标点以及实时点云信息中与目标点所对应的点之间的距离误差,采用最小二乘法对特征矩阵的值进行迭代计算,得到目标特征矩阵;According to the distance error between the target point and the point corresponding to the target point in the real-time point cloud information, the value of the feature matrix is iteratively calculated using the least square method to obtain the target feature matrix;
根据目标特征矩阵,获得目标定位信息。According to the target feature matrix, the target positioning information is obtained.
在一些实施例中,第二得到子模块具体用于:In some embodiments, the second obtaining submodule is specifically used for:
采用SVD方法对目标特征矩阵求解,得到目标旋转矩阵;The SVD method is used to solve the target feature matrix and obtain the target rotation matrix;
根据目标旋转矩阵,得到目标定位信息。According to the target rotation matrix, the target positioning information is obtained.
在一些实施例中,车辆定位装置500还包括:In some embodiments, the vehicle positioning device 500 further includes:
更新模块,用于根据目标定位信息,更新车辆在地图中的实际位置;An update module, used to update the actual position of the vehicle in the map according to the target positioning information;
获得模块,用于根据实际位置以及用户所输入的目标位置,得到车辆的行驶路径。The acquisition module is used to obtain the vehicle's driving path based on the actual position and the target position input by the user.
关于上述实施例中的装置,其中各个模块执行操作的具体方式已经在有关该方法的实 施例中进行了详细描述,此处将不做详细阐述说明。Regarding the device in the above embodiment, the specific manner in which each module performs operations has been described in detail in the embodiment of the method, and will not be elaborated here.
此外,为实现上述目的,本公开的实施例还提供一种车辆,车辆包括:In addition, to achieve the above-mentioned purpose, an embodiment of the present disclosure further provides a vehicle, the vehicle comprising:
处理器和存储器,存储器存储有能够被处理器执行的机器可执行指令,处理器用于执行机器可执行指令,以实现上述车辆定位方法。A processor and a memory, wherein the memory stores machine executable instructions that can be executed by the processor, and the processor is used to execute the machine executable instructions to implement the above-mentioned vehicle positioning method.
请参阅图3,图3是根据一示例性实施例示出的一种车辆600的功能框图示意图。例如,车辆600可以是混合动力车辆,也可以是非混合动力车辆、电动车辆、燃料电池车辆或者其他类型的车辆。车辆600可以是自动驾驶车辆、半自动驾驶车辆或者非自动驾驶车辆。Please refer to FIG3 , which is a functional block diagram of a vehicle 600 according to an exemplary embodiment. For example, the vehicle 600 may be a hybrid vehicle, a non-hybrid vehicle, an electric vehicle, a fuel cell vehicle, or other types of vehicles. The vehicle 600 may be an autonomous vehicle, a semi-autonomous vehicle, or a non-autonomous vehicle.
参照图3,车辆600可包括各种子系统,例如,信息娱乐系统610、感知系统620、决策控制系统630、驱动系统640以及计算平台650。其中,车辆600还可以包括更多或更少的子系统,并且每个子系统都可包括多个部件。另外,车辆600的每个子系统之间和每个部件之间可以通过有线或者无线的方式实现互连。3 , the vehicle 600 may include various subsystems, such as an infotainment system 610, a perception system 620, a decision control system 630, a drive system 640, and a computing platform 650. The vehicle 600 may also include more or fewer subsystems, and each subsystem may include multiple components. In addition, each subsystem and each component of the vehicle 600 may be interconnected by wire or wireless means.
在一些实施例中,信息娱乐系统610可以包括通信系统,娱乐系统以及导航系统等。In some embodiments, the infotainment system 610 may include a communication system, an entertainment system, and a navigation system, etc.
感知系统620可以包括若干种传感器,用于感测车辆600周边的环境的信息。例如,感知系统620可包括全球定位系统(全球定位系统可以是GPS系统,也可以是北斗系统或者其他定位系统)、惯性测量单元(inertial measurement unit,IMU)、激光雷达、毫米波雷达、超声雷达以及摄像装置。The perception system 620 may include several sensors for sensing information about the environment around the vehicle 600. For example, the perception system 620 may include a global positioning system (the global positioning system may be a GPS system, or a Beidou system or other positioning systems), an inertial measurement unit (IMU), a laser radar, a millimeter wave radar, an ultrasonic radar, and a camera device.
决策控制系统630可以包括计算系统、整车控制器、转向系统、油门以及制动系统。The decision control system 630 may include a computing system, a vehicle controller, a steering system, a throttle, and a braking system.
驱动系统640可以包括为车辆600提供动力运动的组件。在一个实施例中,驱动系统640可以包括引擎、扭矩源、传动系统和车轮。引擎可以是内燃机、电动机、空气压缩引擎中的一种或者多种的组合。引擎能够将扭矩源提供的扭矩转换成机械扭矩。The drive system 640 may include components that provide power movement for the vehicle 600. In one embodiment, the drive system 640 may include an engine, a torque source, a transmission system, and wheels. The engine may be one or a combination of multiple of an internal combustion engine, an electric motor, and an air compression engine. The engine is capable of converting the torque provided by the torque source into mechanical torque.
车辆600的部分或所有功能受计算平台650控制。计算平台650可包括至少一个处理器651和第一存储器652,处理器651可以执行存储在第一存储器652中的指令653。Some or all functions of the vehicle 600 are controlled by a computing platform 650. The computing platform 650 may include at least one processor 651 and a first memory 652, and the processor 651 may execute instructions 653 stored in the first memory 652.
处理器651可以是任何常规的处理器,诸如商业可获得的CPU。处理器还可以包括诸如图像处理器(Graphic Process Unit,GPU),现场可编程门阵列(Field Programmable Gate Array,FPGA)、片上系统(System on Chip,SOC)、专用集成芯片(Application Specific Integrated Circuit,ASIC)或它们的组合。The processor 651 may be any conventional processor, such as a commercially available CPU. The processor may also include a graphics processor (Graphic Process Unit, GPU), a field programmable gate array (Field Programmable Gate Array, FPGA), a system on chip (System on Chip, SOC), an application specific integrated circuit (Application Specific Integrated Circuit, ASIC) or a combination thereof.
第一存储器652可以由任何类型的易失性或非易失性存储设备或者它们的组合实现,如静态随机存取存储器(SRAM),电可擦除可编程只读存储器(EEPROM),可擦除可编程只读存储器(EPROM),可编程只读存储器(PROM),只读存储器(ROM),磁存储器,快闪存储器,磁盘或光盘。The first memory 652 can be implemented by any type of volatile or non-volatile storage device or a combination thereof, such as static random access memory (SRAM), electrically erasable programmable read-only memory (EEPROM), erasable programmable read-only memory (EPROM), programmable read-only memory (PROM), read-only memory (ROM), magnetic memory, flash memory, magnetic disk or optical disk.
除了指令653以外,第一存储器652还可存储数据,例如道路地图,路线信息,车辆的位置、方向、速度等数据。第一存储器652存储的数据可以被计算平台650使用。In addition to the instructions 653 , the first memory 652 may also store data, such as road maps, route information, and data such as the location, direction, and speed of the vehicle. The data stored in the first memory 652 may be used by the computing platform 650 .
在本公开实施例中,处理器651可以执行指令653,以完成上述的车辆定位方法的全部或部分步骤。In the embodiment of the present disclosure, the processor 651 may execute the instruction 653 to complete all or part of the steps of the above-mentioned vehicle positioning method.
请参阅图4,图4是根据一示例性实施例示出的一种用于车辆定位方法的装置1900的框图。例如,装置1900可以被提供为一服务器。参照图4,装置1900包括处理组件1922,其进一步包括一个或多个处理器,以及由第二存储器1932所代表的存储器资源,用于存储可由处理组件1922的执行的指令,例如应用程序。第二存储器1932中存储的应用程序可以包括一个或一个以上的每一个对应于一组指令的模块。此外,处理组件1922被配置为执行指令,以执行上述车辆定位方法。Please refer to FIG. 4, which is a block diagram of a device 1900 for a vehicle positioning method according to an exemplary embodiment. For example, the device 1900 can be provided as a server. Referring to FIG. 4, the device 1900 includes a processing component 1922, which further includes one or more processors, and a memory resource represented by a second memory 1932 for storing instructions that can be executed by the processing component 1922, such as an application. The application stored in the second memory 1932 may include one or more modules, each of which corresponds to a set of instructions. In addition, the processing component 1922 is configured to execute instructions to perform the above-mentioned vehicle positioning method.
装置1900还可以包括一个电源组件1926被配置为执行装置1900的电源管理,一个有线或无线网络接口1950被配置为将装置1900连接到网络,和一个输入/输出接口1958。装置1900可以操作基于存储在第二存储器1932的操作系统,例如Windows ServerTM, Mac OS XTM,UnixTM,LinuxTM,FreeBSDTM或类似。The device 1900 may also include a power supply component 1926 configured to perform power management of the device 1900, a wired or wireless network interface 1950 configured to connect the device 1900 to a network, and an input/output interface 1958. The device 1900 may operate based on an operating system stored in the second memory 1932, such as Windows ServerTM, Mac OS XTM, UnixTM, LinuxTM, FreeBSDTM or the like.
本公开还提供一种计算机可读存储介质,其上存储有计算机程序指令,该程序指令被处理器执行时实现本公开提供的车辆定位方法的步骤。The present disclosure also provides a computer-readable storage medium having computer program instructions stored thereon, and the program instructions, when executed by a processor, implement the steps of the vehicle positioning method provided by the present disclosure.
在另一示例性实施例中,还提供一种计算机程序产品,该计算机程序产品包含能够由可编程的装置执行的计算机程序,该计算机程序具有当由该可编程的装置执行时用于执行上述的车辆定位方法的代码部分。In another exemplary embodiment, a computer program product is also provided. The computer program product includes a computer program executable by a programmable device. The computer program has a code portion for executing the above-mentioned vehicle positioning method when executed by the programmable device.
本领域技术人员在考虑说明书及实践本公开后,将容易想到本公开的其它实施方案。本申请旨在涵盖本公开的任何变型、用途或者适应性变化,这些变型、用途或者适应性变化遵循本公开的一般性原理并包括本公开未公开的本技术领域中的公知常识或惯用技术手段。说明书和实施例仅被视为示例性的,本公开的真正范围和精神由下面的权利要求指出。Those skilled in the art will readily appreciate other embodiments of the present disclosure after considering the specification and practicing the present disclosure. This application is intended to cover any variations, uses or adaptations of the present disclosure, which follow the general principles of the present disclosure and include common knowledge or customary technical means in the art that are not disclosed in the present disclosure. The specification and examples are to be regarded as exemplary only, and the true scope and spirit of the present disclosure are indicated by the following claims.
应当理解的是,本公开并不局限于上面已经描述并在附图中示出的精确结构,并且可以在不脱离其范围进行各种修改和改变。本公开的范围仅由所附的权利要求来限制。It should be understood that the present disclosure is not limited to the exact structures that have been described above and shown in the drawings, and that various modifications and changes may be made without departing from the scope thereof. The scope of the present disclosure is limited only by the appended claims.

Claims (10)

  1. 一种车辆定位方法,其特征在于,所述方法包括:A vehicle positioning method, characterized in that the method comprises:
    在车辆上电后,获取所述车辆的第一定位信息以及在上次下电前所存储的第二定位信息;After the vehicle is powered on, obtaining the first positioning information of the vehicle and the second positioning information stored before the vehicle was powered off last time;
    根据所述第一定位信息和所述第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式;Determine a target positioning method from different positioning methods according to a magnitude relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold;
    根据目标定位方式,确定所述车辆的目标定位信息。According to the target positioning method, the target positioning information of the vehicle is determined.
  2. 根据权利要求1所述的方法,其特征在于,根据所述第一定位信息和所述第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式的步骤,包括:The method according to claim 1, characterized in that the step of determining the target positioning mode from different positioning modes according to the size relationship between the deviation value between the first positioning information and the second positioning information and a preset deviation threshold value comprises:
    在所述偏差值小于所述偏差阈值的情况下,确定所述目标定位方式为第一定位方式,所述第一定位方式是将所述第一定位信息确定为所述目标定位信息的方式。When the deviation value is less than the deviation threshold, the target positioning mode is determined to be a first positioning mode, where the first positioning mode is a mode of determining the first positioning information as the target positioning information.
  3. 根据权利要求1所述的方法,其特征在于,根据所述第一定位信息和所述第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式的步骤,包括:The method according to claim 1, characterized in that the step of determining the target positioning mode from different positioning modes according to the size relationship between the deviation value between the first positioning information and the second positioning information and a preset deviation threshold value comprises:
    在所述偏差值大于所述偏差阈值的情况下,确定所述目标定位方式为第二定位方式,所述第二定位方式是根据车辆周围的环境图像以及所述第一定位信息,确定所述目标定位信息的方式。When the deviation value is greater than the deviation threshold, the target positioning method is determined to be a second positioning method, where the second positioning method is a method of determining the target positioning information based on an environmental image around the vehicle and the first positioning information.
  4. 根据权利要求3所述的方法,其特征在于,根据目标定位方式,确定所述车辆的目标定位信息的步骤,包括:The method according to claim 3 is characterized in that the step of determining the target positioning information of the vehicle according to the target positioning method comprises:
    在确定所述目标定位方式为所述第二定位方式的情况下,获取所述环境图像;When it is determined that the target positioning mode is the second positioning mode, acquiring the environment image;
    根据所述环境图像,得到车辆所在车位的编号信息;According to the environment image, obtaining the number information of the parking space where the vehicle is located;
    根据所述编号信息以及所述第一定位信息,得到所述目标定位信息。The target positioning information is obtained according to the numbering information and the first positioning information.
  5. 根据权利要求4所述的方法,其特征在于,根据所述编号信息以及所述第一定位信息,得到所述目标定位信息的步骤,包括:The method according to claim 4, characterized in that the step of obtaining the target positioning information according to the numbering information and the first positioning information comprises:
    根据所述第一定位信息,获得车辆的实时点云信息;Obtaining real-time point cloud information of the vehicle according to the first positioning information;
    根据所述编号信息,确定车辆所在车位的车位点云信息;Determine the parking spot cloud information of the parking space where the vehicle is located according to the number information;
    采用ICP算法对所述实时点云信息以及所述车位点云信息进行配准,获得所述目标定位信息。The ICP algorithm is used to align the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information.
  6. 根据权利要求5所述的方法,其特征在于,采用ICP算法对所述实时点云信息以及所述车位点云信息进行配准,获得所述目标定位信息的步骤,包括:The method according to claim 5 is characterized in that the step of using an ICP algorithm to register the real-time point cloud information and the parking spot point cloud information to obtain the target positioning information comprises:
    根据所述车位点云信息,初始化所述实时点云信息的特征矩阵的值;Initializing the value of the feature matrix of the real-time point cloud information according to the parking spot cloud information;
    从所述车位点云信息中获取与所述实时点云信息之间满足距离条件的目标点;Acquire a target point that satisfies a distance condition with respect to the real-time point cloud information from the parking spot cloud information;
    根据所述目标点以及所述实时点云信息中与所述目标点所对应的点之间的距离误差,采用最小二乘法对所述特征矩阵的值进行迭代计算,得到目标特征矩阵;According to the distance error between the target point and the point corresponding to the target point in the real-time point cloud information, the value of the feature matrix is iteratively calculated using the least square method to obtain a target feature matrix;
    根据所述目标特征矩阵,获得所述目标定位信息。The target positioning information is obtained according to the target feature matrix.
  7. 根据权利要求6所述的方法,其特征在于,根据所述目标特征矩阵,获得所述目标定位信息的步骤,包括:The method according to claim 6, characterized in that the step of obtaining the target positioning information according to the target feature matrix comprises:
    采用SVD方法对所述目标特征矩阵求解,得到目标旋转矩阵;The target feature matrix is solved by using the SVD method to obtain a target rotation matrix;
    根据所述目标旋转矩阵,得到所述目标定位信息。The target positioning information is obtained according to the target rotation matrix.
  8. 根据权利要求1所述的方法,其特征在于,在根据目标定位方式,确定所述车辆的目标定位信息的步骤之后,所述方法还包括:The method according to claim 1, characterized in that after the step of determining the target positioning information of the vehicle according to the target positioning method, the method further comprises:
    根据所述目标定位信息,更新车辆在地图中的实际位置;According to the target positioning information, updating the actual position of the vehicle in the map;
    根据所述实际位置以及用户所输入的目标位置,得到车辆的行驶路径。The vehicle's driving path is obtained according to the actual position and the target position input by the user.
  9. 一种车辆定位装置,其特征在于,所述装置包括:A vehicle positioning device, characterized in that the device comprises:
    获取模块,用于在车辆上电后,获取所述车辆的第一定位信息以及在上次下电前所存储的第二定位信息;An acquisition module, used to acquire the first positioning information of the vehicle and the second positioning information stored before the vehicle was powered off last time after the vehicle was powered on;
    第一确定模块,用于根据所述第一定位信息和所述第二定位信息之间的偏差值以及预设的偏差阈值之间的大小关系,从不同的定位方式中确定出目标定位方式;A first determination module, configured to determine a target positioning mode from different positioning modes according to a magnitude relationship between a deviation value between the first positioning information and the second positioning information and a preset deviation threshold;
    第二确定模块,用于根据目标定位方式,确定所述车辆的目标定位信息。The second determination module is used to determine the target positioning information of the vehicle according to the target positioning method.
  10. 一种车辆,其特征在于,所述车辆包括:A vehicle, characterized in that the vehicle comprises:
    处理器和存储器,所述存储器存储有能够被所述处理器执行的机器可执行指令,所述处理器用于执行机器可执行指令,以实现如权利要求1-8任一项所述的车辆定位方法。A processor and a memory, wherein the memory stores machine executable instructions that can be executed by the processor, and the processor is used to execute the machine executable instructions to implement the vehicle positioning method according to any one of claims 1 to 8.
PCT/CN2022/133346 2022-11-09 2022-11-21 Vehicle localization method and apparatus, and vehicle WO2024098463A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202211399770.9 2022-11-09
CN202211399770.9A CN118046890A (en) 2022-11-09 2022-11-09 Vehicle positioning method and device and vehicle

Publications (1)

Publication Number Publication Date
WO2024098463A1 true WO2024098463A1 (en) 2024-05-16

Family

ID=91031817

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/133346 WO2024098463A1 (en) 2022-11-09 2022-11-21 Vehicle localization method and apparatus, and vehicle

Country Status (2)

Country Link
CN (1) CN118046890A (en)
WO (1) WO2024098463A1 (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110723151A (en) * 2019-09-24 2020-01-24 华为技术有限公司 Intelligent driving system initialization method and device
US20200182625A1 (en) * 2018-12-07 2020-06-11 Ninebot (Beijing) Tech Co., Ltd. Position Update Method, Position Display Method and Vehicle
CN112835085A (en) * 2020-07-09 2021-05-25 北京京东乾石科技有限公司 Method and device for determining vehicle position
CN114516322A (en) * 2022-02-24 2022-05-20 重庆长安汽车股份有限公司 System and method for parking out vehicle, vehicle and computer storage medium
CN114839659A (en) * 2022-04-13 2022-08-02 合众新能源汽车有限公司 Vehicle positioning method and device

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20200182625A1 (en) * 2018-12-07 2020-06-11 Ninebot (Beijing) Tech Co., Ltd. Position Update Method, Position Display Method and Vehicle
CN110723151A (en) * 2019-09-24 2020-01-24 华为技术有限公司 Intelligent driving system initialization method and device
CN112835085A (en) * 2020-07-09 2021-05-25 北京京东乾石科技有限公司 Method and device for determining vehicle position
CN114516322A (en) * 2022-02-24 2022-05-20 重庆长安汽车股份有限公司 System and method for parking out vehicle, vehicle and computer storage medium
CN114839659A (en) * 2022-04-13 2022-08-02 合众新能源汽车有限公司 Vehicle positioning method and device

Also Published As

Publication number Publication date
CN118046890A (en) 2024-05-17

Similar Documents

Publication Publication Date Title
US11530924B2 (en) Apparatus and method for updating high definition map for autonomous driving
US11346950B2 (en) System, device and method of generating a high resolution and high accuracy point cloud
JP6878493B2 (en) Pitch angle correction method used for autonomous vehicles (ADV)
CN111238494B (en) Carrier, carrier positioning system and carrier positioning method
US20200018852A1 (en) System and method for calibrating a lidar and a camera together using semantic segmentation
US20180196127A1 (en) Systems and methods for automatically calibrating a lidar using information from a secondary vehicle
US11158065B2 (en) Localization of a mobile unit by means of a multi hypothesis kalman filter method
CN111736586B (en) Method for automatically driving vehicle position for path planning and device thereof
CN111837136A (en) Autonomous navigation based on local sensing and associated systems and methods
US20240054895A1 (en) Parking method and apparatus, storage medium, chip and vehicle
CN116380088B (en) Vehicle positioning method and device, vehicle and storage medium
WO2024098463A1 (en) Vehicle localization method and apparatus, and vehicle
US20210080264A1 (en) Estimation device, estimation method, and computer program product
CN115718304A (en) Target object detection method, target object detection device, vehicle and storage medium
WO2023102445A1 (en) Automatic bootstrap for autonomous vehicle localization
US11865724B2 (en) Movement control method, mobile machine and non-transitory computer readable storage medium
CN114427863A (en) Vehicle positioning method and system, automatic parking method and system, and storage medium
US11543506B2 (en) Method and computer device for calibrating LIDAR system
US11170049B2 (en) Method for position estimation of vehicle based on graph structure and vehicle using the same
CN116678423B (en) Multisource fusion positioning method, multisource fusion positioning device and vehicle
RU2792946C1 (en) Method and computer device for lidar system calibration
US20230351679A1 (en) System and method for optimizing a bounding box using an iterative closest point algorithm
CN116659529B (en) Data detection method, device, vehicle and storage medium
WO2023017624A1 (en) Drive device, vehicle, and method for automated driving and/or assisted driving
US11859994B1 (en) Landmark-based localization methods and architectures for an autonomous vehicle

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: 22964930

Country of ref document: EP

Kind code of ref document: A1