CN204452203U - 一种自动泊车过程中车身航向角的计算*** - Google Patents
一种自动泊车过程中车身航向角的计算*** Download PDFInfo
- Publication number
- CN204452203U CN204452203U CN201520058731.1U CN201520058731U CN204452203U CN 204452203 U CN204452203 U CN 204452203U CN 201520058731 U CN201520058731 U CN 201520058731U CN 204452203 U CN204452203 U CN 204452203U
- Authority
- CN
- China
- Prior art keywords
- vehicle body
- data processing
- processing module
- chip microprocessor
- microprocessor mcu
- 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.)
- Expired - Fee Related
Links
Landscapes
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本实用新型提供了一种自动泊车过程中车身航向角的计算***，包括传感器模块、数据处理模块、单片机MCU、电源模块以及显示屏；电源模块分别与传感器模块、数据处理模块、单片机MCU均相连，用于为其他各模块提供电源；传感器模块与数据处理模块连接，用于采集信息，并将距离信息传送给数据处理模块，数据处理模块连接单片机MCU，用于处理传感器模块传送的信息，并最终将有效信息传送给单片机MCU；单片机MCU计算得出汽车的实时车身航向角，并输出至显示屏。该计算处理过程简洁，实时性强，能够有效提高车身航向角的检测精度，可有效帮助驾驶员了解当前车身姿态情况，以更好的利于泊车，改善泊车效果。
Description
技术领域
本实用新型涉及自动泊车技术领域，尤其涉及一种自动泊车过程中车身航向角的计算***。
背景技术
随着汽车保有量的不断增加，泊车难题越来越受到人们关注，自动泊车***的出现解决了日益困扰车主的泊车难题。车身航向角检测是自动泊车***的一个重要环节，自动泊车***中的智能算法都是依据汽车航向角来制定的，而现有自动泊车***的路径规划都假定汽车初始航向角为0°，以此来制定泊车路径中每一步的行驶距离，使汽车最终泊车入位时车身平行于车位线，但在实际交通状况下，由于驾驶员操纵、实际路况以及其他不可预估因素均可能造成车身初始航向角不为0°，此时将对实际泊车效果产生较大影响。精确的车身航向角计算不仅有助于驾驶员实时了解当前的车身姿态情况，还能为自动泊车***路径规划的库内调整阶段提供准确的车身航向角，改善泊车效果。
现有自动泊车***中车身姿态检测方法大多是依靠超声波探测技术和机器视觉技术，其中机器视觉技术的应用更为广泛。超声波探测器的应用是在汽车尾部安装2～4个超声波传感器探测与后车距离，通过监测几个超声波传感器探测的探测距离是否相同来判断车身姿态，但超声波探测器在应用上存在着一些不足，尤其是超声波的散射、反射问题比较严重，在汽车的前后端圆角处存在接收不到回波的现象；机器视觉技术的应用是通过内置算法结合汽车尾部的摄像头来匹配车位线，以此调整车身姿态，但此方法只适用于垂直泊车。
实用新型内容
针对现有技术中存在不足，本实用新型提供了一种自动泊车过程中车身航向角的计算***，帮助驾驶员实时了解当前的车身姿态情况，为自动泊车***路径规划的调整阶段提供准确的车身航向角，改善泊车效果。
本实用新型是通过以下技术手段实现上述技术目的的。
一种自动泊车过程中车身航向角的计算***，包括传感器模块、数据处理模块、单片机MCU、电源模块以及显示屏；
所述电源模块分别与传感器模块、数据处理模块、单片机MCU均相连，用于为传感器模块、数据处理模块和单片机模块提供电源；
所述传感器模块包括超声波传感器、轮速传感器和方向盘转角传感器，与数据处理模块连接，所述超声波传感器用于采集汽车与侧方车位内已停放车辆的距离信息；所述轮速传感器用于采集车轮的轮速脉冲信号；所述方向盘转角传感器用于采集汽车的方向盘转角信息；
所述数据处理模块连接单片机MCU，用于接收传感器模块传送的信息，实现对超声波传感器所采集距离信息的筛选、轮速传感器所采集轮速脉冲信号的累加、方向盘转角传感器所采集的方向盘转角信息的转换，并最终将有效信息传送给单片机MCU；
所述单片机MCU连接显示屏，用于接受数据处理模块传送的有效信息，计算得出汽车的实时车身航向角，并输出至显示屏。
进一步的，所述超声波传感器为四个，且车身两侧各分布有两个；所述轮速传感器为两个，且安装在主减速器上；所述方向盘转角传感器为一个，且安装在方向盘下方的转向柱内。
进一步的，分布于车身同侧的所述两个超声波传感器为相互间隔且布置高度相同。
进一步的，所述单片机MCU采用英飞凌公司的增强型单片机XC866。
本实用新型的有益效果是：
(1)本实用新型通过传感器模块、数据处理模块、单片机MCU、电源模块以及显示屏等设备，实现了自动泊车过程中车身航向角的实时计算，该计算处理过程简洁，实时性强，能够有效提高车身航向角的检测精度，可有效帮助驾驶员了解当前车身姿态情况，以更好的利于泊车，改善泊车效果。
(2)本实用新型使用的设备简单，成本低，稳定性高，通用性强，可在汽车上广泛使用。
附图说明
图1为本实用新型所述自动泊车过程中车身航向角的计算***的示意图。
图2为车身同侧的超声波传感器位置示意图。
图3为寻库过程超声波传感器信息采集示意图。
图4为倒库过程中车轮转角与车身航向变化角的关系示意图。
具体实施方式
下面结合附图以及具体实施例对本实用新型作进一步的说明，但本实用新型的保护范围并不限于此。
如图1所示，本实用新型所述的自动泊车过程中车身航向角的计算***，包括传感器模块、数据处理模块、单片机MCU、电源模块以及显示屏；所述传感器模块连接数据处理模块，所述数据处理模块连接单片机MCU，所述单片机MCU连接显示屏；所述电源模块与传感器模块、数据处理模块、单片机MCU均相连；
所述电源模块为整个***提供电源；所述传感器模块包括四个超声波传感器、一个方向盘转角传感器和两个轮速传感器；所述超声波传感器分别用于采集汽车与侧方车位内已停放车辆的距离信息，并将采集到的距离信息传送给数据处理模块，如图2所示，超声波传感器在车身两侧各分布有两个，车身同侧的超声波传感器A和超声波传感器B相隔距离S且布置高度相同。所述两个轮速传感器安装在主减速器上，分别采集左后轮和右后轮的轮速脉冲信号，并将采集到的脉冲信号传送给数据处理模块；所述方向盘转角传感器安装在方向盘下方的转向柱内，用于采集方向盘转角信号并将采集到的方向盘转角信息传送给数据处理模块；所述数据处理模块接收传感器模块传送的信息，并分类对其进行处理，其中，对超声波传感器采集的距离信息进行筛选，对轮速传感器采集的轮速脉冲信号进行累加，对方向盘转角传感器采集的方向盘转角信息进行转换，并最终将有效信息传送给单片机MCU；单片机MCU接收数据处理模块传送的有效信息，计算得出汽车的实时车身航向角，并输出至显示屏；所述显示屏显示瞬时的车身航向角。其中，单片机MCU采用英飞凌公司的增强型单片机XC866。
为方便叙述自动泊车过程中车身航向角的计算方法，以汽车右侧停车为实施例进行说明。
(1)寻库阶段，启动电源，汽车开始寻库，如图3所示，传感器模块中位于车身同侧超声波传感器A和超声波传感器B在线采集汽车与侧方车位内已停放车辆的距离信息(ax，bx)，并将该距离信息传递给数据处理模块；数据处理模块对所采集到的距离信息进行筛选，若|ax-bx|≥1m，则删除该组数值；数据处理模块将筛选后的有效信息(ai，bi)传递给单片机MCU；单片机MCU计算后得到寻库过程中的车身航向角并输出在显示屏上。车身航向角的计算过程为：将单片机MCU接收数据处理模块所传送的距离信息(ai，bi)计算平均值后得到距离参数(av，bv)，即则寻库过程中的车身航向角其中S为为车身同侧的两个超声波传感器的相隔距离。
(2)倒库阶段，轮速传感器采集左后轮和右后轮的轮速脉冲信号，方向盘转角传感器采集方向盘转角信号；数据处理模块对轮速传感器采集的轮速脉冲信号进行累加，对方向盘转角传感器采集的方向盘转角信息进行转换，并将信息传递给单片机MCU；单片机MCU计算后得到倒库过程中的车身航向变化角
车身航向角计算过程为：如图4所示，设汽车倒库阶段每隔时间t汽车航向角变化汽车运动距离为l，数据处理模块利用汽车的固有转向比K将方向盘转角传感器测到的方向盘
转角θj转换为车轮转角φj，即做如下变换：其中方向盘右转记为正角度，左转记为负角度；由Ackerman转向原理可知其中L为汽车轴距，R为转向半径，由此可得出t时刻的转向半径结合弧长公式可得t时间内车身航向角变化则车身航向角
(3)结合寻库阶段和倒库阶段车身航向角和可得出自动泊车过程中的车身航向角并将其输出显示在显示屏上。
本实用新型整个计算过程处理简洁，能够有效地提高车身航向角的检测精度，可有效帮助驾驶员了解当前车身姿态情况，使用的设备简单，成本低，稳定性高，通用性强，可在汽车上广泛使用。
所述实施例为本实用新型的优选的实施方式，但本实用新型并不限于上述实施方式，在不背离本实用新型的实质内容的情况下，本领域技术人员能够做出的任何显而易见的改进、替换或变型均属于本实用新型的保护范围。
Claims (4)
1.一种自动泊车过程中车身航向角的计算***，其特征在于，包括传感器模块、数据处理模块、单片机MCU、电源模块以及显示屏；
所述电源模块分别与传感器模块、数据处理模块、单片机MCU均相连，用于为传感器模块、数据处理模块和单片机模块提供电源；
所述传感器模块包括超声波传感器、轮速传感器和方向盘转角传感器，与数据处理模块连接，所述超声波传感器用于采集汽车与侧方车位内已停放车辆的距离信息；所述轮速传感器用于采集车轮的轮速脉冲信号；所述方向盘转角传感器用于采集汽车的方向盘转角信息；
所述数据处理模块连接单片机MCU，用于接收传感器模块传送的信息，实现对超声波传感器所采集距离信息的筛选、轮速传感器所采集轮速脉冲信号的累加、方向盘转角传感器所采集的方向盘转角信息的转换，并最终将有效信息传送给单片机MCU；
所述单片机MCU连接显示屏，用于接受数据处理模块传送的有效信息，计算得出汽车的实时车身航向角，并输出至显示屏。
2.根据权利要求1所述的一种自动泊车过程中车身航向角的计算***，其特征在于，所述超声波传感器为四个，且车身两侧各分布有两个；所述轮速传感器为两个，且安装在主减速器上；所述方向盘转角传感器为一个，且安装在方向盘下方的转向柱内。
3.根据权利要求1或2所述的一种自动泊车过程中车身航向角的计算***，其特征在于，分布于车身同侧的所述两个超声波传感器为相互间隔且布置高度相同。
4.根据权利要求1或2所述的一种自动泊车过程中车身航向角的计算***，其特征在于，所述单片机MCU采用英飞凌公司的增强型单片机XC866。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201520058731.1U CN204452203U (zh) | 2015-01-27 | 2015-01-27 | 一种自动泊车过程中车身航向角的计算*** |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201520058731.1U CN204452203U (zh) | 2015-01-27 | 2015-01-27 | 一种自动泊车过程中车身航向角的计算*** |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN204452203U true CN204452203U (zh) | 2015-07-08 |
Family
ID=53659132
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201520058731.1U Expired - Fee Related CN204452203U (zh) | 2015-01-27 | 2015-01-27 | 一种自动泊车过程中车身航向角的计算*** |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN204452203U (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104627068A (zh) * | 2015-01-27 | 2015-05-20 | 江苏大学 | 一种自动泊车过程中车身航向角的计算***及方法 |
| CN107272671A (zh) * | 2016-03-31 | 2017-10-20 | 福特全球技术公司 | 用于机动车辆远程控制的遥控装置 |
-
2015
- 2015-01-27 CN CN201520058731.1U patent/CN204452203U/zh not_active Expired - Fee Related
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104627068A (zh) * | 2015-01-27 | 2015-05-20 | 江苏大学 | 一种自动泊车过程中车身航向角的计算***及方法 |
| CN104627068B (zh) * | 2015-01-27 | 2017-01-18 | 江苏大学 | 一种自动泊车过程中车身航向角的计算方法 |
| CN107272671A (zh) * | 2016-03-31 | 2017-10-20 | 福特全球技术公司 | 用于机动车辆远程控制的遥控装置 |
| CN107272671B (zh) * | 2016-03-31 | 2022-03-22 | 福特全球技术公司 | 用于机动车辆远程控制的遥控装置 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104627068A (zh) | 一种自动泊车过程中车身航向角的计算***及方法 | |
| CN101923782B (zh) | 基于地磁传感技术的交通车辆速度获取方法 | |
| CN103057470B (zh) | 一种车辆违章压线预先提示装置及其提示方法 | |
| CN102288121B (zh) | 一种基于单目视觉的车道偏离距离测量及预警方法 | |
| CN203318408U (zh) | 自动泊车*** | |
| CN105679024B (zh) | 一种道路交叉口排队长度计算方法 | |
| CN103754219A (zh) | 一种多传感器信息融合的自动泊车*** | |
| CN105774655B (zh) | 一种倾斜车位探测装置及方法 | |
| CN101510355A (zh) | 一种交叉口进口道禁止变换车道线长度的确定方法 | |
| CN204452203U (zh) | 一种自动泊车过程中车身航向角的计算*** | |
| CN107516423A (zh) | 一种基于视频的车辆行驶方向检测方法 | |
| CN203332108U (zh) | 一种危险驾驶行为识别装置 | |
| CN203422849U (zh) | 一种延时计算处理式led交通信号标志牌自动开闭*** | |
| CN103050014A (zh) | 交通车速检测***及检测方法 | |
| CN203132515U (zh) | 车载路面激光平整度检测装置 | |
| CN204124125U (zh) | 一种前方车辆运动状态追踪预测装置 | |
| CN102214396A (zh) | 基于微波检测的智能交通*** | |
| CN101882377A (zh) | 一种利用超声波探测并进行红绿灯智能配时的方法 | |
| CN205737520U (zh) | 一种用于汽车的并线辅助*** | |
| CN104608768A (zh) | 一种前方目标车辆进入弯道和进行换道的辨别装置及方法 | |
| CN205334755U (zh) | 一种山区高速公路特殊线形路段险态判别装置 | |
| CN104867338A (zh) | 一种自适应交通灯控制*** | |
| CN205292418U (zh) | 车辆变道辅助预警*** | |
| CN202145133U (zh) | 一种靠边停车时路边距测量和监控装置 | |
| CN204229228U (zh) | 一种全智能太阳能汽车无人操作控制装置 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150708 Termination date: 20190127 |