实施方案
[0020] 下面结合附图以及具体实施例对本发明作进一步的说明,需要指出的是,下面仅以一种最优化的技术方案对本发明的技术方案以及设计原理进行详细阐述,但本发明的保护范围并不限于此。
[0021] 所述实施例为本发明的优选的实施方式,但本发明并不限于上述实施方式,在不背离本发明的实质内容的情况下,本领域技术人员能够做出的任何显而易见的改进、替换或变型均属于本发明的保护范围。
[0022] 本发明所述的一种基于超声波雷达的自动泊车寻库试验数据采集装置,包括车辆模拟装置、导轨装置以及中控机,如图1所示,其中:
[0023] 车辆模拟装置包括底座(1)、立柱(2)、雷达夹具(3)、MCU1(4)、舵机1(5)、超声波雷达(6)、舵机2(101)、轮速传感器(102)、滚动装置;底座(1)用于承载车辆模拟装置;立柱(2)垂直固定在底座(1)上,用于安装雷达夹具(3);雷达夹具(3)用于固定超声波雷达(6),可上下移动,通过紧固螺栓固定在立柱(2)上;雷达夹具(3)上装有容栅传感器,容栅传感器可用于测量超声波雷达(6)高度并发送给MCU1(4);舵机1(5)在MCU1(4)的控制下用于驱动超声波雷达(6)在铅垂面内上下转动,进一步的控制超声波雷达(6)俯仰角;超声波雷达(6)用于探测障碍物,并将探测到的距离信息发送给MCU1(4);舵机2(101)在MCU1(4)的控制下用于驱动立柱(2)在水平面内转动,进一步的控制超声波雷达(6)在水平面上的投影角;轮速传感器(102)用于测量车辆模拟装置速度并发送给MCU1(4);MCU1(4)用于接收中控机的命令控制舵机1(5)、舵机2(101)的转动角度和轨道轮电机的速度,也用于将超声波雷达探测到的距离数据、超声波雷达(6)的高度、车辆模拟装置实时速度发送给中控机;滚动装置由轨道轮(103)和轨道轮电机组成,由轨道轮电机驱动轨道轮(103)以带动车辆模拟装置在钢轨(901)上移动。
[0024] 导轨装置包括轨道(9)、钢轨(901)、舵机3(902)和MCU2(903),如图2所示。其中,轨道(9)水平放置,用于限定车辆模拟装置运动路线;钢轨(901)用于承载轨道轮(103);舵机3(902)在MCU2(903)的控制下用于驱动轨道(9)在水平面内转动,改变轨道(9)的方向,进一步的控制轨道(9)在水平面内的角度;MCU2(903)用于接收中控机的命令控制舵机3(902)的转动角度。
[0025] 中控机用于设置舵机1(5)和舵机2(101)的目标角度以及车辆模拟装置运动速度,并发送给MCU1(4),也用于设置舵机3(902)目标角并发送给MCU2(903);中控机也用于将每次试验时容栅传感器测量的超声波雷达(6)高度、超声波雷达(6)俯仰角、超声波雷达(6)水平面上的投影角、轮速传感器(102)测量的车辆模拟装置实时速度、轨道(9)在水平面内的角度以及超声波雷达(6)探测到的距离信息作为一组数据记录下来。
[0026] 本发明所述的一种基于超声波雷达的自动泊车寻库试验数据采集装置基于以下方法实现,包括以下步骤:
[0027] 1)水平安装轨道,并将车辆模拟装置安装到轨道上,放置障碍物模拟停车场景;
[0028] 2)设置超声波雷达高度;
[0029] 3)通过中控机设置舵机1、舵机2目标角度以及车辆模拟装置运动速度,并将相应命令发送给MCU1;通过中控机设置舵机3目标角度,并将相应命令发送给MCU2;
[0030] 4)通过舵机1、舵机2控制超声波雷达转动到设定的俯仰角和水平面投影角,通过舵机3控制轨道转动到设定的水平面角度;
[0031] 5)MCU1控制车辆模拟装置按照设置的速度运动,并读取轮速传感器数据获取车辆模拟装置实时速度发送给中控机;
[0032] 6)超声波雷达开始工作,MCU1读取探测到的距离数据并发送给中控机;
[0033] 7)中控机将超声波雷达俯仰角、超声波雷达水平面上的投影角、轨道在水平面内的角度、轮速传感器测量的车辆模拟装置实时速度、容栅传感器测量的超声波雷达高度以及超声波雷达探测到的距离信息作为一组数据记录下来;
[0034] 8)判断试验是否结束,若结束则转步骤9),否则转步骤5);
[0035] 9)试验结束。