CN110490172B - 信息融合泊车的停车位位置补偿方法、系统、装置、介质 - Google Patents

信息融合泊车的停车位位置补偿方法、系统、装置、介质 Download PDF

Info

Publication number
CN110490172B
CN110490172B CN201910797357.XA CN201910797357A CN110490172B CN 110490172 B CN110490172 B CN 110490172B CN 201910797357 A CN201910797357 A CN 201910797357A CN 110490172 B CN110490172 B CN 110490172B
Authority
CN
China
Prior art keywords
wheel speed
parking
speed pulse
vehicle
wheel
Prior art date
Legal status (The legal status 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 status listed.)
Active
Application number
CN201910797357.XA
Other languages
English (en)
Other versions
CN110490172A (zh
Inventor
王俊红
杨波
刘旺
宋平
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Yinwo Automotive Technology Co ltd
Original Assignee
Beijing Yinwo Automotive Technology Co ltd
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 Beijing Yinwo Automotive Technology Co ltd filed Critical Beijing Yinwo Automotive Technology Co ltd
Priority to CN201910797357.XA priority Critical patent/CN110490172B/zh
Publication of CN110490172A publication Critical patent/CN110490172A/zh
Application granted granted Critical
Publication of CN110490172B publication Critical patent/CN110490172B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Purposes 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/06—Automatic manoeuvring for parking
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T3/00—Geometric image transformation in the plane of the image
    • G06T3/40—Scaling the whole image or part thereof
    • G06T3/4038—Scaling the whole image or part thereof for image mosaicing, i.e. plane images composed of plane sub-images
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • G06V20/586—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads of parking space

Abstract

本发明提供了信息融合泊车的停车位位置补偿方法、系统、装置、介质，其对停车位位置加入补偿机制，提高了停车位位置的准确度，方法包括以下步骤：采集车辆四周环境的视频数据，同时获取原车信号；分别对采集到的视频数据和获取的原车信号加入时间戳；对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像；对全景图像中的停车位进行识别，得到停车位，将识别得到的停车位作为车辆的停车位置；通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号；将停车位置对应的原车信号与实时获取的原车信号对比，进行位置补偿，根据补偿结果更新停车位置。

Description

信息融合泊车的停车位位置补偿方法、系统、装置、介质
技术领域
本发明涉及自动泊车技术领域，具体涉及信息融合泊车的停车位位置补偿方法、系统、装置、介质。
背景技术
自动泊车系统(Automatic Parking System，APS)是一个集环境感知、决策与规划，智能控制与执行等功能于一体的综合系统，是智能驾驶辅助系统的重要组成部分；目前自动泊车系统的主要流程是，图像和原车信号的采集，图像360度环视拼接，由算法模块决定出一个有效的停车位位置，自动泊车模块根据停车位的位置和原车信号进行泊车动作，如公开号为CN109435942A的专利公开了一种基于信息融合的车位线车位识别方法及装置，其可以实现车位线车位的识别。
类似上述专利中提到的方案，在目前的方案中，获取停车位的位置和获取原车信号在不同的处理器中，获取停车位的位置模块会经过很多软件模块，而获取原车信号经过的软件模块比较少，这样在到达自动泊车算法模块之前，停车位的位置信息就会滞后原车信号的信息，这样直接会影响到泊车的性能。
发明内容
针对上述问题，本发明提供了信息融合泊车的停车位位置补偿方法、系统、装置、介质，其对停车位位置加入补偿机制，提高了停车位位置的准确度。
其技术方案是这样的：信息融合泊车的停车位位置补偿方法，其特征在于，包括以下步骤：
步骤1：采集车辆四周环境的视频数据，同时获取原车信号；
步骤2：分别对采集到的视频数据和获取的原车信号加入时间戳；
步骤3：对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像；对全景图像中的停车位进行识别，得到停车位，将识别得到的停车位作为车辆的停车位置；
步骤4：通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号；将停车位置对应的原车信号与实时获取的原车信号对比，进行位置补偿，根据补偿结果更新停车位置。
进一步的，原车信号包括超声波信号和轮速脉冲计数。
进一步的，在停车位进行识别的过程中，通过超声波信号识别车位内有无障碍物的检测；利用轮速传感器获取的轮速脉冲计数，得到行驶距离，将行驶距离与全景图像做融合获取车位角点坐标，得到停车位。
进一步的，位置补偿具体如下：将与停车位置匹配的原车信号的轮速脉冲值标记为第一轮速脉冲值，把实时获取的原车信号中的轮速脉冲值标记为第二轮速脉冲值；通过第一轮速脉冲值和第二轮速脉冲值，来计算采集到停车位置的时间到当前的时间间隔内，车辆在x方向的偏移量ΔXo、在y方向的偏移量ΔYo；将融合信息中的停车位位置的横坐标和纵坐标分别减去ΔXo、ΔYo，获得位置补偿后的当前的停车位置。
进一步的，车辆在x方向的偏移量ΔXo、在y方向的偏移量ΔYo，具体通过如下公式计算：
Δxo＝Δx+dor*sinΔφ
Δyo＝Δy-dor+dor*cosΔφ
其中，dor表示车辆后轴中心到车辆中心的距离，ΔX为后轴中心在x方向的偏移量；ΔY为后轴中心在y方向上的偏移量；Δφ为姿态角增量；
姿态角增量Δφ通过如下公式得到：
Figure BDA0002181344210000021
其中，ΔSRL为左后轮的行驶距离，ΔSRR为右后轮的行驶距离，DRAxle为后轴轮距；
左后轮的行驶距离ΔSRL通过如下公式得到：
ΔSRL＝ΔRLCounter*Cal_CoefS*VehGear
其中，ΔRLCounter为左后轮的轮速脉冲差值，Cal_CoefS为轮速计数值与行驶距离的换算系数，VehGear车辆行驶方向，前进挡为1，倒挡为-1；
后轮的行驶距离ΔSRR通过如下公式得到：
ΔSRR＝ΔRRCounter*Cal_CoefS*VehGear
其中，ΔRRCounter为右后轮的轮速脉冲差值，Cal_CoefS为轮速计数值与行驶距离的换算系数，VehGear车辆行驶方向，前进挡为1，倒挡为-1；
若当前轮速计数值和历史轮速计数值均未超过最大值，则ΔRLCounter和ΔRRCounter分别通过如下公式计算：
ΔRLCounter＝RLCounter2-RLCounter1
RLCounter1为左后轮的第一轮速脉冲值，RLCounter2为左后轮的第二轮速脉冲值；
ΔRRCounter＝RRCounter2-RRCounter1
RRCounter1为右后轮的第一轮速脉冲值，RRCounter2为右后轮的第二轮速脉冲值；
若当前轮速计数值超过最大值，历史轮速计数值未超过最大值，则ΔRLCounter和ΔRRCounter分别通过如下公式计算：
ΔRLCounter＝RLCounter2-RLCounter1+Cal_PulseCounterMaxValue
RLCounter1为左后轮的第一轮速脉冲值，RLCounter2为左后轮的第二轮速脉冲值，Cal_PulseCounterMaxValue为速脉冲值的最大值；
ΔRRCounter＝RRCounter2-RRCounter1+Cal_PulseCounterMaxValue
RRCounter1为左后轮的第一轮速脉冲值，RRCounter2为左后轮的第二轮速脉冲值，Cal_PulseCounterMaxValue为速脉冲值的最大值。
进一步的，后轴中心在x方向的偏移量ΔX和后轴中心在y方向上的偏移量ΔY通过如下公式得到：
Δx＝ΔS*sinΔφ
Δy＝ΔS*cosΔφ
其中，ΔS为车辆后轴中心的行驶距离,Δφ为姿态角增量；
车辆后轴中心的行驶距离ΔS通过如下公式计算得到：
Figure BDA0002181344210000031
其中，ΔSRL为左后轮的行驶距离，ΔSRR为右后轮的行驶距离。
信息融合泊车的停车位位置补偿系统，其特征在于，包括：
视频采集模块，用于采集车辆四周环境的视频数据；
原车信号获取模块，用于获取原车信号；
第一控制器，第一控制器分别对采集到的视频数据和获取的原车信号加入时间戳，对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像；对全景图像中的停车位进行识别，得到停车位，将识别得到的停车位作为车辆的停车位置，通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号，并将停车位置和停车位置对应的图像数据的时间戳下的原车信号发送给第二控制器；
第二控制器，第二控制器通过原车信号获取模块获取实时的原车信号，将来自所述第一控制器的停车位置对应的原车信号与获取的实时的原车信号对比，进行位置补偿，根据补偿结果更新停车位置。
一种信息融合泊车的停车位位置补偿装置，其特征在于，其包括：包括处理器、存储器以及程序；
所述程序存储在所述存储器中，所述处理器调用存储器存储的程序，以执行上述的信息融合泊车的停车位位置补偿方法。
一种计算机可读存储介质，其特征在于，所述计算机可读存储介质被配置成存储程序，所述程序被配置成执行上述的述的信息融合泊车的停车位位置补偿方法。
本发明的信息融合泊车的停车位位置补偿方法、系统、装置、介质，对采集到的视频数据和获取的原车信号加入时间戳；对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像，对全景图像中的停车位进行识别，得到停车位作为车辆的停车位置，然后通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号，通过对两种来源的原车信号进行对比，然后用对比的结果进行补偿，来减少软件流程上造成的误差，提高了停车位位置的准确度。
附图说明
图1为本发明的信息融合泊车的停车位位置补偿方法的流程图；
图2为本发明的信息融合泊车的停车位位置补偿系统的框图。
具体实施方式
见图1，本发明的信息融合泊车的停车位位置补偿方法，包括以下步骤：
步骤1：采集车辆四周环境的视频数据，同时获取原车信号；
步骤2：分别对采集到的视频数据和获取的原车信号加入时间戳；
步骤3：对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像；对全景图像中的停车位进行识别，得到停车位，将识别得到的停车位作为车辆的停车位置；
步骤4：通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号；将停车位置对应的原车信号与实时获取的原车信号对比，进行位置补偿，根据补偿结果更新停车位置。
具体的，在步骤1中，原车信号包括超声波信号和轮速脉冲计数。
在步骤3中，在停车位进行识别的过程中，通过超声波信号识别车位内有无障碍物的检测；利用轮速传感器获取的轮速脉冲计数，得到行驶距离，将行驶距离与全景图像做融合获取车位角点坐标，得到停车位。
具体在本实施例中，位置补偿如下：将与停车位置匹配的原车信号的轮速脉冲值标记为第一轮速脉冲值，把实时获取的原车信号中的轮速脉冲值标记为第二轮速脉冲值；通过第一轮速脉冲值和第二轮速脉冲值，来计算采集到停车位置的时间到当前的时间间隔内，车辆在x方向的偏移量ΔXo、在y方向的偏移量ΔYo；将融合信息中的停车位位置的横坐标和纵坐标分别减去ΔXo、ΔYo，获得位置补偿后的当前的停车位置。
具体的，车辆在x方向的偏移量ΔXo、在y方向的偏移量ΔYo，具体通过如下公式计算：
Δxo＝Δx+dor*sinΔφ
Δyo＝Δy-dor+dor*cosΔφ
其中，dor表示车辆后轴中心到车辆中心的距离，ΔX为后轴中心在x方向的偏移量；ΔY为后轴中心在y方向上的偏移量；Δφ为姿态角增量；
姿态角增量Δφ通过如下公式得到：
Figure BDA0002181344210000051
其中，ΔSRL为左后轮的行驶距离，ΔSRR为右后轮的行驶距离，DRAxle为后轴轮距；
左后轮的行驶距离ΔSRL通过如下公式得到：
ΔSRL＝ΔRLCounter*Cal_CoefS*VehGear
其中，ΔRLCounter为左后轮的轮速脉冲差值，Cal_CoefS为轮速计数值与行驶距离的换算系数，VehGear车辆行驶方向，前进挡为1，倒挡为-1；
后轮的行驶距离ΔSRR通过如下公式得到：
ΔSRR＝ΔRRCounter*Cal_CoefS*VehGear
其中，ΔRRCounter为右后轮的轮速脉冲差值，Cal_CoefS为轮速计数值与行驶距离的换算系数，VehGear车辆行驶方向，前进挡为1，倒挡为-1；
若当前轮速计数值和历史轮速计数值均未超过最大值，则ΔRLCounter和ΔRRCounter分别通过如下公式计算：
ΔRLCounter＝RLCounter2-RLCounter1
RLCounter1为左后轮的第一轮速脉冲值，RLCounter2为左后轮的第二轮速脉冲值；
ΔRRCounter＝RRCounter2-RRCounter1
RRCounter1为右后轮的第一轮速脉冲值，RRCounter2为右后轮的第二轮速脉冲值；
若当前轮速计数值超过最大值，历史轮速计数值未超过最大值，则ΔRLCounter和ΔRRCounter分别通过如下公式计算：
ΔRLCounter＝RLCounter2-RLCounter1+Cal_PulseCounterMaxValue
RLCounter1为左后轮的第一轮速脉冲值，RLCounter2为左后轮的第二轮速脉冲值，Cal_PulseCounterMaxValue为速脉冲值的最大值；
ΔRRCounter＝RRCounter2-RRCounter1+Cal_PulseCounterMaxValue
RRCounter1为左后轮的第一轮速脉冲值，RRCounter2为左后轮的第二轮速脉冲值，Cal_PulseCounterMaxValue为速脉冲值的最大值。
具体的，后轴中心在x方向的偏移量ΔX和后轴中心在y方向上的偏移量ΔY通过如下公式得到：
Δx＝ΔS*sinΔφ
Δy＝ΔS*cosΔφ
其中，ΔS为车辆后轴中心的行驶距离,Δφ为姿态角增量；
车辆后轴中心的行驶距离ΔS通过如下公式计算得到：
Figure BDA0002181344210000071
其中，ΔSRL为左后轮的行驶距离，ΔSRR为右后轮的行驶距离。
见图2，本发明还提供了一种信息融合泊车的停车位位置补偿系统，包括：
视频采集模块1，用于采集车辆四周环境的视频数据；
原车信号获取模块2，用于获取原车信号；
第一控制器3，第一控制器分别对采集到的视频数据和获取的原车信号加入时间戳，对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像；对全景图像中的停车位进行识别，得到停车位，将识别得到的停车位作为车辆的停车位置，通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号，并将停车位置和停车位置对应的图像数据的时间戳下的原车信号发送给第二控制器；
第二控制器4，第二控制器通过原车信号获取模块获取实时的原车信号，将来自第一控制器的停车位置对应的原车信号与获取的实时的原车信号对比，进行位置补偿，根据补偿结果更新停车位置。
在本发明的实施例中，还提供了一种信息融合泊车的停车位位置补偿装置，其包括：包括处理器、存储器以及程序；
程序存储在存储器中，处理器调用存储器存储的程序，以执行上述的信息融合泊车的停车位位置补偿方法。
在上述信息融合泊车的停车位位置补偿装置的实现中，存储器和处理器之间直接或间接地电性连接，以实现数据的传输或交互。例如，这些元件相互之间可以通过一条或者多条通信总线或信号线实现电性连接，如可以通过总线连接。存储器中存储有实现数据访问控制方法的计算机执行指令，包括至少一个可以软件或固件的形式存储于存储器中的软件功能模块，处理器通过运行存储在存储器内的软件程序以及模块，从而执行各种功能应用以及数据处理。
在本发明的实施例中，还提供了一种计算机可读存储介质，计算机可读存储介质被配置成存储程序，程序被配置成执行上述的信息融合泊车的停车位位置补偿方法。
本领域普通技术人员可以理解：实现上述各方法实施例的全部或部分步骤可以通过程序指令相关的硬件来完成。前述的程序可以存储于计算机可读存储介质中。该程序在被处理器执行时，实现包括上述各方法实施例的步骤；而前述的计算机可读存储介质包括：ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质，包括若干指令用以使得一台大数据传输设备执行各个实施例或者实施例的某些部分所述的方法。
本发明的信息融合泊车的停车位位置补偿方法、系统、装置、介质，对采集到的视频数据和获取的原车信号加入时间戳；对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像，对全景图像中的停车位进行识别，得到停车位作为车辆的停车位置，然后通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号，通过对两种来源的原车信号进行对比，然后用对比的结果进行补偿，来减少软件流程上造成的误差，提高了停车位位置的准确度。

Claims (5)

1.信息融合泊车的停车位位置补偿方法，其特征在于，包括以下步骤：
步骤1：采集车辆四周环境的视频数据，同时获取原车信号；
步骤2：分别对采集到的视频数据和获取的原车信号加入时间戳；
步骤3：对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像；对全景图像中的停车位进行识别，得到停车位，将识别得到的停车位作为车辆的停车位置；
步骤4：通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号；将停车位置对应的原车信号与实时获取的原车信号对比，进行位置补偿，根据补偿结果更新停车位置；
原车信号包括超声波信号和轮速脉冲计数；
在停车位进行识别的过程中，通过超声波信号识别车位内有无障碍物的检测；利用轮速传感器获取的轮速脉冲计数，得到行驶距离，将行驶距离与全景图像做融合获取车位角点坐标，得到停车位；
位置补偿具体如下：将与停车位置匹配的原车信号的轮速脉冲值标记为第一轮速脉冲值，把实时获取的原车信号中的轮速脉冲值标记为第二轮速脉冲值；通过第一轮速脉冲值和第二轮速脉冲值，来计算采集到停车位置的时间到当前的时间间隔内，车辆在x方向的偏移量ΔXo、在y方向的偏移量ΔYo；将融合信息中的停车位位置的横坐标和纵坐标分别减去ΔXo、ΔYo，获得位置补偿后的当前的停车位置；
车辆在x方向的偏移量ΔXo、在y方向的偏移量ΔYo，具体通过如下公式计算：
Δxo＝Δx+dor*sinΔφ
Δyo＝Δy-dor+dor*cosΔφ
其中，dor表示车辆后轴中心到车辆中心的距离，ΔX为后轴中心在x方向的偏移量；ΔY为后轴中心在y方向上的偏移量；Δφ为姿态角增量；
姿态角增量Δφ通过如下公式得到：
Figure FDA0003498318980000011
其中，ΔSRL为左后轮的行驶距离，ΔSRR为右后轮的行驶距离，DRAxle为后轴轮距；
左后轮的行驶距离ΔSRL通过如下公式得到：
ΔSRL＝ΔRLCounter*Cal_CoefS*VehGear
其中，ΔRLCounter为左后轮的轮速脉冲差值，Cal_CoefS为轮速计数值与行驶距离的换算系数，VehGear车辆行驶方向，前进挡为1，倒挡为-1；
后轮的行驶距离ΔSRR通过如下公式得到：
ΔSRR＝ΔRRCounter*Cal_CoefS*VehGear
其中，ΔRRCounter为右后轮的轮速脉冲差值，Cal_CoefS为轮速计数值与行驶距离的换算系数，VehGear车辆行驶方向，前进挡为1，倒挡为-1；
若当前轮速计数值和历史轮速计数值均未超过最大值，则ΔRLCounter和ΔRRCounter分别通过如下公式计算：
ΔRLCounter＝RLCounter2-RLCounter1
RLCounter1为左后轮的第一轮速脉冲值，RLCounter2为左后轮的第二轮速脉冲值；
ΔRRCounter＝RRCounter2-RRCounter1
RRCounter1为右后轮的第一轮速脉冲值，RRCounter2为右后轮的第二轮速脉冲值；
若当前轮速计数值超过最大值，历史轮速计数值未超过最大值，则ΔRLCounter和ΔRRCounter分别通过如下公式计算：
ΔRLCounter＝RLCounter2-RLCounter1+Cal_PulseCounterMaxValue
RLCounter1为左后轮的第一轮速脉冲值，RLCounter2为左后轮的第二轮速脉冲值，Cal_PulseCounterMaxValue为轮速脉冲值的最大值；
ΔRRCounter＝RRCounter2-RRCounter1+Cal_PulseCounterMaxValue
RRCounter1为左后轮的第一轮速脉冲值，RRCounter2为左后轮的第二轮速脉冲值，Cal_PulseCounterMaxValue为轮速脉冲值的最大值。
2.根据权利要求1所述的信息融合泊车的停车位位置补偿方法，其特征在于：后轴中心在x方向的偏移量ΔX和后轴中心在y方向上的偏移量ΔY通过如下公式得到：
Δx＝ΔS*sinΔφ
Δy＝ΔS*cosΔφ
其中，ΔS为车辆后轴中心的行驶距离,Δφ为姿态角增量；
车辆后轴中心的行驶距离ΔS通过如下公式计算得到：
Figure FDA0003498318980000031
其中，ΔSRL为左后轮的行驶距离，ΔSRR为右后轮的行驶距离。
3.信息融合泊车的停车位位置补偿系统，其特征在于，包括：
视频采集模块，用于采集车辆四周环境的视频数据；
原车信号获取模块，用于获取原车信号；
第一控制器，第一控制器分别对采集到的视频数据和获取的原车信号加入时间戳，对于采集车辆四周环境的视频数据中的图像数据进行拼接，得到车辆四周环境的全景图像；对全景图像中的停车位进行识别，得到停车位，将识别得到的停车位作为车辆的停车位置，通过停车位置对应的图像数据的时间戳，获得该时间戳下对应的原车信号，并将停车位置和停车位置对应的图像数据的时间戳下的原车信号发送给第二控制器；
第二控制器，第二控制器通过原车信号获取模块获取实时的原车信号，将来自所述第一控制器的停车位置对应的原车信号与获取的实时的原车信号对比，进行位置补偿，根据补偿结果更新停车位置；
原车信号包括超声波信号和轮速脉冲计数；
在停车位进行识别的过程中，通过超声波信号识别车位内有无障碍物的检测；利用轮速传感器获取的轮速脉冲计数，得到行驶距离，将行驶距离与全景图像做融合获取车位角点坐标，得到停车位；
位置补偿具体如下：将与停车位置匹配的原车信号的轮速脉冲值标记为第一轮速脉冲值，把实时获取的原车信号中的轮速脉冲值标记为第二轮速脉冲值；通过第一轮速脉冲值和第二轮速脉冲值，来计算采集到停车位置的时间到当前的时间间隔内，车辆在x方向的偏移量ΔXo、在y方向的偏移量ΔYo；将融合信息中的停车位位置的横坐标和纵坐标分别减去ΔXo、ΔYo，获得位置补偿后的当前的停车位置；
车辆在x方向的偏移量ΔXo、在y方向的偏移量ΔYo，具体通过如下公式计算：
Δxo＝Δx+dor*sinΔφ
Δyo＝Δy-dor+dor*cosΔφ
其中，dor表示车辆后轴中心到车辆中心的距离，ΔX为后轴中心在x方向的偏移量；ΔY为后轴中心在y方向上的偏移量；Δφ为姿态角增量；
姿态角增量Δφ通过如下公式得到：
Figure FDA0003498318980000041
其中，ΔSRL为左后轮的行驶距离，ΔSRR为右后轮的行驶距离，DRAxle为后轴轮距；
左后轮的行驶距离ΔSRL通过如下公式得到：
ΔSRL＝ΔRLCounter*Cal_CoefS*VehGear
其中，ΔRLCounter为左后轮的轮速脉冲差值，Cal_CoefS为轮速计数值与行驶距离的换算系数，VehGear车辆行驶方向，前进挡为1，倒挡为-1；
后轮的行驶距离ΔSRR通过如下公式得到：
ΔSRR＝ΔRRCounter*Cal_CoefS*VehGear
其中，ΔRRCounter为右后轮的轮速脉冲差值，Cal_CoefS为轮速计数值与行驶距离的换算系数，VehGear车辆行驶方向，前进挡为1，倒挡为-1；
若当前轮速计数值和历史轮速计数值均未超过最大值，则ΔRLCounter和ΔRRCounter分别通过如下公式计算：
ΔRLCounter＝RLCounter2-RLCounter1
RLCounter1为左后轮的第一轮速脉冲值，RLCounter2为左后轮的第二轮速脉冲值；
ΔRRCounter＝RRCounter2-RRCounter1
RRCounter1为右后轮的第一轮速脉冲值，RRCounter2为右后轮的第二轮速脉冲值；
若当前轮速计数值超过最大值，历史轮速计数值未超过最大值，则ΔRLCounter和ΔRRCounter分别通过如下公式计算：
ΔRLCounter＝RLCounter2-RLCounter1+Cal_PulseCounterMaxValue
RLCounter1为左后轮的第一轮速脉冲值，RLCounter2为左后轮的第二轮速脉冲值，Cal_PulseCounterMaxValue为轮速脉冲值的最大值；
ΔRRCounter＝RRCounter2-RRCounter1+Cal_PulseCounterMaxValue
RRCounter1为左后轮的第一轮速脉冲值，RRCounter2为左后轮的第二轮速脉冲值，Cal_PulseCounterMaxValue为轮速脉冲值的最大值。
4.一种信息融合泊车的停车位位置补偿装置，其特征在于，其包括：包括处理器、存储器以及程序；
所述程序存储在所述存储器中，所述处理器调用存储器存储的程序，以执行权利要求1所述的信息融合泊车的停车位位置补偿方法。
5.一种计算机可读存储介质，其特征在于，所述计算机可读存储介质被配置成存储程序，所述程序被配置成执行权利要求1所述的信息融合泊车的停车位位置补偿方法。
CN201910797357.XA 2019-08-27 2019-08-27 信息融合泊车的停车位位置补偿方法、系统、装置、介质 Active CN110490172B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910797357.XA CN110490172B (zh) 2019-08-27 2019-08-27 信息融合泊车的停车位位置补偿方法、系统、装置、介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910797357.XA CN110490172B (zh) 2019-08-27 2019-08-27 信息融合泊车的停车位位置补偿方法、系统、装置、介质

Publications (2)

Publication Number Publication Date
CN110490172A CN110490172A (zh) 2019-11-22
CN110490172B true CN110490172B (zh) 2022-04-08

Family

ID=68553618

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910797357.XA Active CN110490172B (zh) 2019-08-27 2019-08-27 信息融合泊车的停车位位置补偿方法、系统、装置、介质

Country Status (1)

Country Link
CN (1) CN110490172B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111563474A (zh) * 2020-05-18 2020-08-21 北京茵沃汽车科技有限公司 运动背景下的基于车载鱼眼镜头的障碍物检测方法、系统
CN112330977B (zh) * 2020-10-28 2022-05-13 广州小鹏自动驾驶科技有限公司 一种自动泊车的方法和装置
CN112614050B (zh) * 2020-12-01 2024-03-22 深圳市豪恩汽车电子装备股份有限公司 机动车车底路面图像获取装置及方法
CN112633152B (zh) * 2020-12-22 2021-11-26 深圳佑驾创新科技有限公司 停车位检测方法、装置、计算机设备和存储介质
CN112644479B (zh) * 2021-01-07 2022-05-13 广州小鹏自动驾驶科技有限公司 一种泊车控制方法和装置
CN113085838A (zh) * 2021-04-02 2021-07-09 的卢技术有限公司 一种基于多传感器融合的车位检测方法和系统
CN112983085A (zh) * 2021-04-30 2021-06-18 的卢技术有限公司 一种基于视觉的车位线识别方法
CN113183952B (zh) * 2021-06-03 2022-05-27 上海电机学院 一种基于坐标补偿的自动停车方法及系统
CN114882733B (zh) * 2022-03-15 2023-12-01 深圳市德驰微视技术有限公司 基于域控制器的停车位获取方法、电子设备及存储介质

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106945660A (zh) * 2017-02-24 2017-07-14 宁波吉利汽车研究开发有限公司 一种自动泊车系统
CN107618503A (zh) * 2017-08-29 2018-01-23 广州小鹏汽车科技有限公司 一种自动泊车控制方法及系统
CN108860141A (zh) * 2018-06-26 2018-11-23 奇瑞汽车股份有限公司 泊车方法、装置及存储介质
CN108928343A (zh) * 2018-08-13 2018-12-04 吉利汽车研究院（宁波）有限公司 一种全景融合自动泊车系统及方法
CN109159769A (zh) * 2018-08-09 2019-01-08 厦门市杜若科技有限公司 一种基于视频定位的自动存车、取车方法与系统
WO2019098353A1 (ja) * 2017-11-17 2019-05-23 アイシン精機株式会社 車両位置推定装置および車両制御装置
CN109859260A (zh) * 2017-11-30 2019-06-07 华为技术有限公司 确定车位位置的方法、装置及计算机可读存储介质

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106945660A (zh) * 2017-02-24 2017-07-14 宁波吉利汽车研究开发有限公司 一种自动泊车系统
CN107618503A (zh) * 2017-08-29 2018-01-23 广州小鹏汽车科技有限公司 一种自动泊车控制方法及系统
WO2019098353A1 (ja) * 2017-11-17 2019-05-23 アイシン精機株式会社 車両位置推定装置および車両制御装置
CN109859260A (zh) * 2017-11-30 2019-06-07 华为技术有限公司 确定车位位置的方法、装置及计算机可读存储介质
CN108860141A (zh) * 2018-06-26 2018-11-23 奇瑞汽车股份有限公司 泊车方法、装置及存储介质
CN109159769A (zh) * 2018-08-09 2019-01-08 厦门市杜若科技有限公司 一种基于视频定位的自动存车、取车方法与系统
CN108928343A (zh) * 2018-08-13 2018-12-04 吉利汽车研究院（宁波）有限公司 一种全景融合自动泊车系统及方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
基于超声波传感器的自动泊车车位补偿检测法;何伟;《中国仪器仪表》;20160406;全文 *

Also Published As

Publication number Publication date
CN110490172A (zh) 2019-11-22

Similar Documents

Publication Publication Date Title
CN110490172B (zh) 信息融合泊车的停车位位置补偿方法、系统、装置、介质
CN109902637B (zh) 车道线检测方法、装置、计算机设备和存储介质
EP3689695A1 (en) Vehicle position estimation device and vehicle control device
CN112009462B (zh) 一种前向自动泊车方法及装置
CN110587597A (zh) 一种基于激光雷达的slam闭环检测方法及检测系统
CN111209956A (zh) 传感器数据融合方法、车辆的环境地图生成方法及系统
CN110942038A (zh) 基于视觉的交通场景识别方法、装置、介质及电子设备
CN110979313A (zh) 一种基于空间地图的自动泊车定位方法及系统
CN111144330A (zh) 一种基于深度学习的车道线检测方法、装置以及设备
US11332124B2 (en) Vehicular control system
US8044998B2 (en) Sensing apparatus and method for vehicles
CN115436917A (zh) Lidar视轴对准误差和主车辆定位误差的协同估计和校正
CN112967316B (zh) 一种面向3d多目标追踪的运动补偿优化方法及系统
CN117308972A (zh) 车辆定位方法、装置和存储介质及电子设备
CN113763504A (zh) 地图更新方法、系统、车载终端、服务器及存储介质
CN112417976A (zh) 一种路面检测识别方法、装置、智能终端及存储介质
CN112241717B (zh) 前车检测方法、前车检测模型的训练获取方法及装置
CN113034538A (zh) 一种视觉惯导设备的位姿跟踪方法、装置及视觉惯导设备
CN114264310A (zh) 定位及导航方法、装置、电子设备、计算机存储介质
US20230266451A1 (en) Online lidar-to-ground alignment
CN115953328B (zh) 一种目标矫正方法、系统及电子设备
CN114821531B (zh) 基于电子外后视镜adas的车道线识别图像显示系统
US20230147739A1 (en) Automatic detection of lidar to vehicle alignment state using localization data
CN117429410A (zh) 一种基于视觉slam和uwb感知融合的商用车自动入库方法
CN115294766A (zh) 虚拟红绿灯构建方法、装置、设备及存储介质

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant