CN104062971B - 智能车自动行车控制系统及其控制方法 - Google Patents
智能车自动行车控制系统及其控制方法 Download PDFInfo
- Publication number
- CN104062971B CN104062971B CN201310511186.2A CN201310511186A CN104062971B CN 104062971 B CN104062971 B CN 104062971B CN 201310511186 A CN201310511186 A CN 201310511186A CN 104062971 B CN104062971 B CN 104062971B
- Authority
- CN
- China
- Prior art keywords
- master controller
- trajectory
- intelligent vehicle
- navigation
- car body
- 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
Links
Landscapes
- Traffic Control Systems (AREA)
- Navigation (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种智能车自动行车控制系统及其控制方法。本实用解决现有技术缺少安全可靠的智能车的问题,其技术方案要点是:所述的导航轨迹线包括主导航轨迹线、分设主导航轨迹线两边且与主导航轨迹线平行的辅助导航轨迹线和埋设在主导航轨迹线正下方的磁导航轨迹线,所述的导航识别模块包括与主导航轨迹线相对应的主视频识别导航模块、磁感应模块和与辅助导航轨迹线相对应的辅助视频识别导航模块,所述的无线通信模块、主视频识别导航模块、磁感应模块和辅助视频识别导航模块均与所述的主控制器连接,所述通信设备与无线通信模块通信连接。本发明安全可靠,稳定性高。
Description
技术领域
本发明涉及在封闭环境下的自动车及其控制方法,尤其涉及一种智能车自动行车控制系统及其控制方法。
背景技术
随着中国汽车保有量的增加,由此产生的问题越来越尖锐,主要是两方面的问题:能源、环保问题和交通拥堵问题。目前来看,能源与环保问题的最佳解决方案是纯电动车取代传统燃油车,以实现零排放。解决交通拥堵问题的最佳方案是智能交通(即ITS),使得交通参与者均以最佳的效率运行,尽管人们找到了解决两大问题的钥匙,但是由于成本高昂和技术复杂的原因,导致纯电动车和智能交通无法普及。
中国专利公开号CN101414191A公开了一种无人驾驶车辆的线路方法,用阑珊固定无人驾驶车辆的行车线路,阑珊分阑珊区和阑珊间隔区,阑珊区分安置磁块,传感器,超声波等通讯有用的部件区域和不安置磁块、传感器、超声波等通讯有用的部件的区域,在无人驾驶车辆上安置对置的联系阑珊安置区域内的磁块、传感器、超声波、发出器、接受器、处理器等通讯有用的部件,由于无人驾驶车辆和阑珊安置磁块、传感器、超声波等通讯有用部件的区域相互通讯的信号不断地发出和接受,不断地处理和校对,使无人驾驶车辆保证行车路线。该专利是通过车辆与线路轨道之间的时时收发信号,根据反馈情况确定行车路线的方法,成本高,系统复杂。
中国专利公告号CN101876827A,公开了一种无人驾驶汽车,包括车体、设于车体外的车载摄像头和传感器、设于车体内的GPS卫星定位系统和电脑控制系统。该专利是通过GPS卫星定位的行车方法,由于路况复杂,实际使用效果大打折扣。
更为主要的是现在的智能车只能进行环线单方向的动作,无法实现双向运行,也就是说,一旦使用者需要回到前方的车站,那么使用者必须乘坐智能车进行近乎一整圈的运行,耗时较长。
发明内容
本发明的目的是为解决目前的技术方案存在只能进行环线单方向的动作的问题,提供一种能够适应在封闭环境下单环线高精度智能寻路智能车自动行车控制系统及其控制方法。
本发明解决其技术问题所采用的技术方案是:一种智能车自动行车控制系统,包括带有显示屏、上位处理器、通信设备和操控台的中央控制室,涂刷于地面上的导航轨迹线、用于识别所述导航轨迹线的导航识别模块以及若干辆相同的智能车车体,所述导航模块设于所述智能车车体上,所述车体上还设有能源模块、无线通信模块、主控制器和电动汽车动力系统,导航识别模块、主控制器和电动汽车动力系统均由能源模块供能,所述电动汽车动力系统和导航识别模块均与所述主控制器电连接,显示屏、上位处理器和通信设备均与操控台连接,所述的导航轨迹线包括主导航轨迹线、分设主导航轨迹线两边且与主导航轨迹线平行的辅助导航轨迹线和埋设在主导航轨迹线正下方的磁导航轨迹线,所述的导航识别模块包括与主导航轨迹线相对应的主视频识别导航模块、磁感应模块和与辅助导航轨迹线相对应的辅助视频识别导航模块,所述的无线通信模块、主视频识别导航模块、磁感应模块和辅助视频识别导航模块均与所述的主控制器连接,所述通信设备与无线通信模块通信连接。本发明采用的是两种四条导航轨迹线共同指路修正前进方向的,智能车车体沿着主导航轨迹线、辅助导航轨迹线和磁导航轨迹线方向进行修正前进角度,即使是不同方向的两车交汇,主控制器也可以根据实际情况调整当前选用的导航轨迹线,同时磁轨迹线对于轨迹线的图形要求条件低,受环境影响小,作为冗余导航轨迹线辅助定位和导航最为合适,本发明能够适应在封闭环境,在交汇时通过相应的控制方法让智能车车体分别充分应用三条导航轨迹线达到单环线高精度智能寻路的作用,使得智能车车体可以单路上执行正反双向运行,同时,本发明还可以由人工进行远程控制,应用前景较好。
作为优选,所述的智能车自动行车控制系统还包括若干个汽车雷达、设置在智能车车体上的推板、推板控制电机和推板控制电机驱动电路,所述汽车雷达和推板控制电机驱动电路均与主控制器电连接,所述主控制器通过推板控制电机驱动电路与所述的推板控制电机连接,所述的若干个汽车雷达均布在所述智能车车体的车体四周。本发明一旦路上有杂物时,智能车可以直接使用推板将较小的杂物推开,节省了时间,一旦有较大的杂物时,则可使用两种四条导航轨迹线来进行绕过杂物的操作。
作为优选,所述的智能车行车控制系统还包括提升夹件、提升夹件驱动器和填补涂料刷,所述填补涂料刷的刷柄内设置有填充涂料的导通腔,所述导通腔与填补涂料刷的刷头导通,所述的提升夹件与所述的填补涂料刷连接,所述提升夹件通过提升夹件驱动器与所述主控制器连接,所述提升夹件包括悬挂与智能车车体尾部的主夹件和两个与智能车车体尾部连接的辅助夹件,所述两个辅助夹件与所述主夹件保持同一直线,所述两个辅助夹件与所述主夹件之间的距离相等,且主导航轨迹线与辅助导航轨迹线之间的距离也与辅助夹件与所述主夹件之间的距离相等。这样设置,可以使用刷头对主导航轨迹线与辅助导航轨迹线进行修复,达到保证下次良好运行的作用。
作为优选,所述的推板包括连杆和尖板,所述连杆的一端与尖板的背部连接,所述连杆的另一端也与所述智能车车体的侧壁为铰接,所述推板控制电机的输出轴与所述连杆连接。
作为优选,主导航轨迹线与辅助导航轨迹线之间的距离大于所述智能车车体的宽度。这样设置,保证了车辆交汇时,有足够的空间用于辆车交汇和定位导航。
作为优选,所述智能车车体的正前方设置有一个伸缩杆,所述伸缩杆的前端与主视频识别导航模块固定连接,所述的主视频识别导航模块和辅助视频识别导航模块均包括数字摄像头、视频处理芯片和数据传输模块,所述的数字摄像头与视频处理芯片电连接,所述视频处理芯片通过数据传输模块与主控制器电连接。这样设置,保证了本发明可以通过伸缩杆的调整摄像头的摄像范围,同时伸缩杆的高度可控,保证了图形大小可以计算转换。
作为优选,所述主导航轨迹线包括中部的白色油漆线和黑色的侧边线,所述的白色油漆线上均布有黑色的横向测速线,所述横向测速线与所述的白色油漆线垂直,所述的智能车车体上还设置有卫星定位模块,所述卫星定位模块与所述的主控制器电连接。这样设置,可以由控制器准确识别和控制智能车车体的前进方向,还能通过横向测速线测试当前速度。
一种智能车自动行车控制方法,适用于如权利要求6所述的智能车自动行车控制系统,包括以下步骤:
步骤一:智能车车体和中央控制室执行初始化;
步骤二:智能车车体启动,导航识别模块对获取的图形数据和磁场数据进行解析,主控制器根据导航识别模块获取的数据进行定位,如果智能车车体位于预定位置则执行步骤四,如果智能车车体位于可控预定位置则执行步骤三,如果智能车车体既未位于预定位置又为位于可控预定位置则发出实时路面信号至中央控制室,使用者在中央控制室通过远程通信对智能车车体进行远程控制;
步骤三:主控制器发出命令抬高伸缩杆将数字摄像头拍摄范围扩大,并根据拍摄到的画面进行画面识别和定位,主控制器根据识别出的图形进行转向修正值计算,同时智能车车体启动汽车雷达作为防撞辅助信号检测装置,汽车雷达侦测智能车车体四周状况,主控制器根据转向修正值控制电动汽车动力系统,电动汽车动力系统动作,智能车车体进行宏观调控移动,当主导航轨迹线位于主视频识别导航模块的数字摄像头拍摄画面中部时,主控制器降低伸缩杆将数字摄像头拍摄范围缩小,主控制器调整电动汽车动力系统,电动汽车动力系统动作,智能车车体进行微观调控移动直至智能车车体位于预定位置,在智能车车体动作时,一旦检测到汽车雷达发出的报警信号,电动汽车动力系统动作停止动作,直到报警信号解除才重新执行电动汽车动力系统动作;
步骤四:正常行驶,电动汽车动力系统动作,主控制器根据获取图形和磁场信号确定前进角度,若在执行步骤四中,主控制器收到卫星定位系统或中央控制室的交汇命令,则跳转执行步骤五,若在执行步骤四中,主控制器收到汽车雷达的报警信号或识别图形信号中出现大于画面设定阈值的无法辨识的数据块时,则跳转执行步骤六,若在执行步骤四中,主控制器收到卫星定位系统或中央控制室的到达终点命令,则跳转执行步骤七,所述设定阈值为人工设定参数;
步骤五:主控制器在限定时间内进行车辆交汇控制;
步骤六:主控制器放下推板,然后主控制器降低车速进行前推操作,直至识别图形信号中不出现大于画面设定阈值的无法辨识的数据块,然后重新跳转步骤四,如果智能车车体无法继续前进则主控制器控制电动汽车动力系统进行倒车操作,然后主控制器发出命令抬高伸缩杆将数字摄像头拍摄范围扩大,并根据拍摄到的画面进行画面识别和定位,如果识别图形信号中依然出现大于画面第二设定阈值的无法辨识的数据块,则主控制器发出信号至中央控制室,中央控制室进行远程控制,如果识别图形信号中未出现大于画面第二设定阈值的无法辨识的数据块,则主控制器在调整控制策略进行绕过障碍物控制;
步骤七:主控制器执行停车操作。
作为优选,所述步骤六中进行绕过障碍物控制包括:第一阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第一预设交汇修正角度附加值计算出交汇第一阶段修正角度值,主控制器根据交汇第一阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第二阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线视为主导航轨迹线,将主导航轨迹线视为辅助导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至辅助视频识别导航模块的识别图形信号中未出现大于画面设定阈值的无法辨识的数据块,主控制器结束第二阶段,第三阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第三预设交汇修正角度附加值计算出交汇第三阶段修正角度值,主控制器根据交汇第三阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第四阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线重新视为辅助导航轨迹线,将主导航轨迹线重新视为主导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至完成突发情况设定距离的第四阶段操作,突发情况设定距离为预设值,主控制器根据横向测速线测定突发情况设定距离,第五阶段,重新跳转执行步骤四;所述的第一预设交汇修正角度附加值和第三预设交汇修正角度附加值均为带有正负的预设值;在智能车车体动作时,一旦检测到汽车雷达发出的报警信号,电动汽车动力系统动作停止动作,直到电动汽车动力系统动作解除才重新执行电动汽车动力系统动作。
作为优选,所述的车辆交汇控制包括:第一阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第一预设交汇修正角度附加值计算出交汇第一阶段修正角度值,主控制器根据交汇第一阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第二阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线视为主导航轨迹线,将主导航轨迹线视为辅助导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至中央控制室根据交汇的辆智能车车体的卫星定位信号发出结束第二阶段命令,第三阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第三预设交汇修正角度附加值计算出交汇第三阶段修正角度值,主控制器根据交汇第三阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第四阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线重新视为辅助导航轨迹线,将主导航轨迹线重新视为主导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至中央控制室根据交汇的辆智能车车体的卫星定位信号发出结束第四阶段命令,第五阶段,重新跳转执行步骤四;所述限定时间为人工设定时间,所述的第一预设交汇修正角度附加值和第三预设交汇修正角度附加值均为带有正负的预设值。
本发明的实质性效果是:本发明结构简单、功能全面,体积小巧,功耗低,很好的线性响应,抗气泡和有机物干扰,抗外部光源影响,低温度系数干扰,输出数据准确。
附图说明
图1是本发明的一种整体结构示意图;
图2是本发明两智能车交汇时运行方向的一种示意图。
图中:1、中央控制室,2、智能车车体,3、主视频识别导航模块,4、辅助视频识别导航模块,5、汽车雷达,6、提升夹件,7、辅助导航轨迹线,8、主导航轨迹线,9、磁导航轨迹线。
具体实施方式
下面通过具体实施例,并结合附图,对本发明的技术方案作进一步的具体说明。
实施例:
一种智能车自动行车控制系统(参见附图1),包括带有显示屏、上位处理器、通信设备和操控台的中央控制室1,涂刷于地面上的导航轨迹线、用于识别所述导航轨迹线的导航识别模块以及若干辆相同的智能车车体2,所述导航模块设于所述智能车车体上,所述车体上还设有能源模块、无线通信模块、主控制器和电动汽车动力系统,导航识别模块、主控制器和电动汽车动力系统均由能源模块供能,所述电动汽车动力系统和导航识别模块均与所述主控制器电连接,显示屏、上位处理器和通信设备均与操控台连接,其特征在于:所述的导航轨迹线包括主导航轨迹线8、分设主导航轨迹线两边且与主导航轨迹线平行的辅助导航轨迹线7和埋设在主导航轨迹线正下方的磁导航轨迹线9,磁导航轨迹线由相同体积和极性方向排列一致的磁块组成,所述的导航识别模块包括与主导航轨迹线相对应的主视频识别导航模块3、磁感应模块和与辅助导航轨迹线相对应的辅助视频识别导航模块4,所述的无线通信模块、主视频识别导航模块、磁感应模块和辅助视频识别导航模块均与所述的主控制器连接,所述通信设备与无线通信模块通信连接。所述的智能车自动行车控制系统还包括若干个汽车雷达5、设置在智能车车体上的推板、推板控制电机和推板控制电机驱动电路,所述汽车雷达和推板控制电机驱动电路均与主控制器电连接,所述主控制器通过推板控制电机驱动电路与所述的推板控制电机连接,所述的若干个汽车雷达均布在所述智能车车体的车体四周。所述的智能车行车控制系统还包括提升夹件6、提升夹件驱动器和填补涂料刷,所述填补涂料刷的刷柄内设置有填充涂料的导通腔,所述导通腔与填补涂料刷的刷头导通,所述的提升夹件与所述的填补涂料刷连接,所述提升夹件通过提升夹件驱动器与所述主控制器连接,所述提升夹件包括悬挂与智能车车体尾部的主夹件和两个与智能车车体尾部连接的辅助夹件,所述两个辅助夹件与所述主夹件保持同一直线,所述两个辅助夹件与所述主夹件之间的距离相等,且主导航轨迹线与辅助导航轨迹线之间的距离也与辅助夹件与所述主夹件之间的距离相等。所述的推板包括连杆和尖板,所述连杆的一端与尖板的背部连接,所述连杆的另一端也与所述智能车车体的侧壁为铰接,所述推板控制电机的输出轴与所述连杆连接。主导航轨迹线与辅助导航轨迹线之间的距离大于所述智能车车体的宽度。所述智能车车体的正前方设置有一个伸缩杆,所述伸缩杆的前端与主视频识别导航模块固定连接,所述的主视频识别导航模块和辅助视频识别导航模块均包括数字摄像头、视频处理芯片和数据传输模块,所述的数字摄像头与视频处理芯片电连接,所述视频处理芯片通过数据传输模块与主控制器电连接。所述主导航轨迹线包括中部的白色油漆线和黑色的侧边线,所述的白色油漆线上均布有黑色的横向测速线,所述横向测速线与所述的白色油漆线垂直,所述的智能车车体上还设置有卫星定位模块,所述卫星定位模块与所述的主控制器电连接。
一种智能车自动行车控制(参见附图2),适用于上述实施例所述的智能车自动行车控制系统,包括以下步骤:
步骤一:智能车车体和中央控制室执行初始化,各设备上电或唤醒,人工设定的初始值导入,主视频识别导航模块、磁感应模块和辅助视频识别导航模块工作,主视频识别导航模块、磁感应模块和辅助视频识别导航模块分别获取导航信号,导航信号包括辅助导航轨迹线图形信号和主导航轨迹线图形信号以及磁场信号,辅助视频识别导航模块根据初始的摄像角度将带有摄像角度的辅助导航轨迹线图形进行转换,转换为辅助导航轨迹线图形的正视图图形,卫星定位模块同时启动定位;
步骤二:智能车车体启动,导航识别模块对获取的图形数据和磁场数据进行解析,主控制器根据导航识别模块获取的数据进行定位,如果智能车车体位于预定位置则执行步骤四,如果智能车车体位于可控预定位置则执行步骤三,如果智能车车体既未位于预定位置又为位于可控预定位置则发出实时路面信号至中央控制室,使用者在中央控制室通过远程通信对智能车车体进行远程控制,所述判断智能车车体位于预定位置条件为获取的图形数据和磁场数据均符合初始设定值,所述判断智能车车体位于可控预定位置条件为当智能车车体至少有一侧车轮位于两条辅助导航轨迹线内;
步骤三:主控制器发出命令抬高伸缩杆将数字摄像头拍摄范围扩大,同时主控制器记录伸缩杆的延展长度,通过计算延展长度和相应的角度值可以计算出摄像头的画面拍摄比例的放大倍数,主控制器根据拍摄到的画面结合画面放大倍数的计算,进行画面识别,寻找主导航轨迹线,根据主导航轨迹线在画面内的位置进行宏观定位,主控制器根据识别出的图形进行转向修正值计算,同时智能车车体启动汽车雷达作为防撞辅助信号检测装置,汽车雷达侦测智能车车体四周状况,主控制器根据转向修正值控制电动汽车动力系统,电动汽车动力系统动作,智能车车体进行宏观调控移动,当主导航轨迹线位于主视频识别导航模块的数字摄像头拍摄画面中部时,主控制器降低伸缩杆将数字摄像头拍摄范围缩小,主控制器记录伸缩杆的延展长度,通过计算延展长度和相应的角度值可以计算出摄像头的画面拍摄比例的放大倍数,主控制器再次根据拍摄到的画面结合画面放大倍数的计算,重新进行画面识别,主控制器重新根据识别出的图形进行转向修正值计算,主控制器调整电动汽车动力系统,电动汽车动力系统根据转向修正值进行动作,智能车车体进行微观调控移动直至智能车车体位于预定位置,在智能车车体动作时,一旦检测到汽车雷达发出的报警信号,电动汽车动力系统动作停止动作,直到报警信号解除才重新执行电动汽车动力系统动作;
步骤四:电动汽车动力系统动作,主控制器根据获取图形和磁场信号确定前进角度,其中图形信号包括主导航轨迹线图形信号和辅助导航轨迹线图形信号,主控制器根据主导航轨迹线图形信号计算出修正角度,主控制器根据辅助导航轨迹线图形信号计算出的辅助修正角度,主控制器根据当前磁场信号计算磁场修正角度,修正角度与辅助修正角度差值在10°以内,则主控制器根据主导航轨迹线图形信号计算出的修正角度驱动电动汽车动力系统,如果修正角度与辅助修正角度差值在10°以上,则计算修正角度与磁场修正角度之间的差值a,同时计算辅助修正角度与磁场修正角度之间的差值b,若差值a小于等于差值b则主控制器根据主导航轨迹线图形信号计算出的修正角度驱动电动汽车动力系统,若差值b小于差值a则主控制器根据辅助导航轨迹线图形信号计算出的辅助修正角度驱动电动汽车动力系统;中央控制室根据智能车车体上的卫星定位信号对智能车车体的速度和位置进行监控,一旦智能车车体既不位于预定位置,同时也不位于可控预定位置,则发出警告至中央控制室,中央控制室根据需求可以决定是否进行远程控制;若在执行步骤四中,主控制器收到卫星定位系统或中央控制室的交汇命令,则跳转执行步骤五,若在执行步骤四中,主控制器收到汽车雷达的报警信号或识别图形信号中出现大于画面设定阈值的无法辨识的数据块时,则跳转执行步骤六,若在执行步骤四中,主控制器收到卫星定位系统或中央控制室的到达终点命令,则跳转执行步骤七,所述设定阈值为人工设定参数;
步骤五:主控制器在限定时间内调整控制策略,第一阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第一预设交汇修正角度附加值计算出交汇第一阶段修正角度值,主控制器根据交汇第一阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第二阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线视为主导航轨迹线,将主导航轨迹线视为辅助导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至中央控制室根据交汇的辆智能车车体的卫星定位信号发出结束第二阶段命令,第三阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第三预设交汇修正角度附加值计算出交汇第三阶段修正角度值,主控制器根据交汇第三阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第四阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线重新视为辅助导航轨迹线,将主导航轨迹线重新视为主导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至中央控制室根据交汇的辆智能车车体的卫星定位信号发出结束第四阶段命令,第五阶段,重新跳转执行步骤四;所述限定时间为人工设定时间,所述的第一预设交汇修正角度附加值和第三预设交汇修正角度附加值均为带有正负的预设值;
步骤六:主控制器放下推板,然后主控制器降低车速进行前推操作,直至识别图形信号中不出现大于画面设定阈值的无法辨识的数据块,然后重新跳转步骤四,如果智能车车体无法继续前进则主控制器控制电动汽车动力系统进行倒车操作,倒车距离为预设值,主控制器根据横向测速线测定倒车距离,倒车操作结束后,主控制器发出命令抬高伸缩杆将数字摄像头拍摄范围扩大,并根据拍摄到的画面进行画面识别和定位,如果识别图形信号中依然出现大于画面第二设定阈值的无法辨识的数据块,则主控制器发出信号至中央控制室,中央控制室进行远程控制,如果识别图形信号中未出现大于画面第二设定阈值的无法辨识的数据块,则主控制器在调整控制策略,第一阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第一预设交汇修正角度附加值计算出交汇第一阶段修正角度值,主控制器根据交汇第一阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第二阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线视为主导航轨迹线,将主导航轨迹线视为辅助导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至辅助视频识别导航模块的识别图形信号中未出现大于画面设定阈值的无法辨识的数据块,主控制器结束第二阶段,第三阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第三预设交汇修正角度附加值计算出交汇第三阶段修正角度值,主控制器根据交汇第三阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第四阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线重新视为辅助导航轨迹线,将主导航轨迹线重新视为主导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至完成突发情况设定距离的第四阶段操作,突发情况设定距离为预设值,主控制器根据横向测速线测定突发情况设定距离,第五阶段,重新跳转执行步骤四;所述的第一预设交汇修正角度附加值和第三预设交汇修正角度附加值均为带有正负的预设值;在智能车车体动作时,一旦检测到汽车雷达发出的报警信号,电动汽车动力系统动作停止动作,直到电动汽车动力系统动作解除才重新执行电动汽车动力系统动作;
步骤七:主控制器执行停车操作。
本实施例在使用时,如果发现主导航轨迹线、分设主导航轨迹线两边且与主导航轨迹线平行的辅助导航轨迹线有污损,主控制器可以通过控制提升夹件对刷头进行控制,起到修补主导航轨迹线和辅助导航轨迹线作用;使用者也可以通过远程发出命令,在远程控制定位完成后,主控制器调整控制策略,将磁导航轨迹线作为唯一参照,进行计算修正角度,驱动电动汽车动力系统进行工作,主控制器可以通过控制提升夹件对刷头进行控制,起到修补主导航轨迹线和辅助导航轨迹线作用,由于磁导航轨迹线探测和计算速度较慢,因此,本实施例中使用磁导航轨迹线作为唯一参照进行污损修补一般在深夜进行。
中央控制室进行远程控制时,中央控制室发出命令抬高伸缩杆将数字摄像头拍摄范围扩大,同时启动汽车雷达和显示卫星定位信号,用于辅助远程控制。本实施例中的画面识别方法为现有技术,本实施例中的磁场信号解析也采用的是现有技术。
本实施例在辆车交汇时还控制一辆车车的提升两个辅助夹件的高度,防止两车辅助夹件相互碰撞。
以上所述的实施例只是本发明的一种较佳的方案,并非对本发明作任何形式上的限制,在不超出权利要求所记载的技术方案的前提下还有其它的变体及改型。
Claims (10)
1.一种智能车自动行车控制系统,包括带有显示屏、上位处理器、通信设备和操控台的中央控制室、导航轨迹线、用于识别所述导航轨迹线的导航识别模块以及若干辆相同的智能车车体,所述导航识别模块设于所述智能车车体上,所述车体上还设有能源模块、无线通信模块、主控制器和电动汽车动力系统,导航识别模块、主控制器和电动汽车动力系统均由能源模块供能,所述电动汽车动力系统和导航识别模块均与所述主控制器电连接,显示屏、上位处理器和通信设备均与操控台连接,其特征在于:所述的导航轨迹线包括主导航轨迹线、分设主导航轨迹线两边且与主导航轨迹线平行的辅助导航轨迹线和埋设在主导航轨迹线正下方的磁导航轨迹线,所述的导航识别模块包括与主导航轨迹线相对应的主视频识别导航模块、磁感应模块和与辅助导航轨迹线相对应的辅助视频识别导航模块,所述的无线通信模块、主视频识别导航模块、磁感应模块和辅助视频识别导航模块均与所述的主控制器连接,所述通信设备与无线通信模块通信连接;在绕过障碍物时,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线视为主导航轨迹线,将主导航轨迹线视为辅助导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度;在车辆交汇时,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线视为主导航轨迹线,将主导航轨迹线视为辅助导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度。
2.根据权利要求1所述的智能车自动行车控制系统,其特征在于:所述的智能车自动行车控制系统还包括若干个汽车雷达、设置在智能车车体上的推板、推板控制电机和推板控制电机驱动电路,所述汽车雷达和推板控制电机驱动电路均与主控制器电连接,所述主控制器通过推板控制电机驱动电路与所述的推板控制电机连接,所述的若干个汽车雷达均布在所述智能车车体的车体四周。
3.根据权利要求2所述的智能车自动行车控制系统,其特征在于:所述的智能车行车控制系统还包括提升夹件、提升夹件驱动器和填补涂料刷,所述填补涂料刷的刷柄内设置有填充涂料的导通腔,所述导通腔与填补涂料刷的刷头导通,所述的提升夹件与所述的填补涂料刷连接,所述提升夹件通过提升夹件驱动器与所述主控制器连接,所述提升夹件包括悬挂与智能车车体尾部的主夹件和两个与智能车车体尾部连接的辅助夹件,所述两个辅助夹件与所述主夹件保持同一直线,所述两个辅助夹件与所述主夹件之间的距离相等,且主导航轨迹线与辅助导航轨迹线之间的距离也与辅助夹件与所述主夹件之间的距离相等。
4.根据权利要求2所述的智能车自动行车控制系统,其特征在于:所述的推板包括连杆和尖板,所述连杆的一端与尖板的背部连接,所述连杆的另一端也与所述智能车车体的侧壁为铰接,所述推板控制电机的输出轴与所述连杆连接。
5.根据权利要求1所述的智能车自动行车控制系统,其特征在于:主导航轨迹线与辅助导航轨迹线之间的距离大于所述智能车车体的宽度。
6.根据权利要求3所述的智能车自动行车控制系统,其特征在于:所述智能车车体的正前方设置有一个伸缩杆,所述伸缩杆的前端与主视频识别导航模块固定连接,所述的主视频识别导航模块和辅助视频识别导航模块均包括数字摄像头、视频处理芯片和数据传输模块,所述的数字摄像头与视频处理芯片电连接,所述视频处理芯片通过数据传输模块与主控制器电连接。
7.根据权利要求1所述的智能车自动行车控制系统,其特征在于:所述主导航轨迹线包括中部的白色油漆线和黑色的侧边线,所述的白色油漆线上均布有黑色的横向测速线,所述横向测速线与所述的白色油漆线垂直,所述的智能车车体上还设置有卫星定位模块,所述卫星定位模块与所述的主控制器电连接。
8.一种智能车自动行车控制方法,适用于如权利要求6所述的智能车自动行车控制系统,其特征在于:包括以下步骤:
步骤一:智能车车体和中央控制室执行初始化;
步骤二:智能车车体启动,导航识别模块对获取的图形数据和磁场数据进行解析,主控制器根据导航识别模块获取的数据进行定位,如果智能车车体位于预定位置则执行步骤四,如果智能车车体位于可控预定位置则执行步骤三,如果智能车车体既未位于预定位置又为位于可控预定位置则发出实时路面信号至中央控制室,使用者在中央控制室通过远程通信对智能车车体进行远程控制;
步骤三:主控制器发出命令抬高伸缩杆将数字摄像头拍摄范围扩大,并根据拍摄到的画面进行画面识别和定位,主控制器根据识别出的图形进行转向修正值计算,同时智能车车体启动汽车雷达作为防撞辅助信号检测装置,汽车雷达侦测智能车车体四周状况,主控制器根据转向修正值控制电动汽车动力系统,电动汽车动力系统动作,智能车车体进行宏观调控移动,当主导航轨迹线位于主视频识别导航模块的数字摄像头拍摄画面中部时,主控制器降低伸缩杆将数字摄像头拍摄范围缩小,主控制器调整电动汽车动力系统,电动汽车动力系统动作,智能车车体进行微观调控移动直至智能车车体位于预定位置,在智能车车体动作时,一旦检测到汽车雷达发出的报警信号,电动汽车动力系统动作停止动作,直到报警信号解除才重新执行电动汽车动力系统动作;
步骤四:正常行驶,电动汽车动力系统动作,主控制器根据获取图形和磁场信号确定前进角度,主控制器根据主导航轨迹线图形信号计算出修正角度,主控制器根据辅助导航轨迹线图形信号计算出的辅助修正角度,主控制器根据当前磁场信号计算磁场修正角度,修正角度与辅助修正角度差值在10°以内,则主控制器根据主导航轨迹线图形信号计算出的修正角度驱动电动汽车动力系统,如果修正角度与辅助修正角度差值在10°以上,则计算修正角度与磁场修正角度之间的差值a,同时计算辅助修正角度与磁场修正角度之间的差值b,若差值a小于等于差值b则主控制器根据主导航轨迹线图形信号计算出的修正角度驱动电动汽车动力系统,若差值b小于差值a则主控制器根据辅助导航轨迹线图形信号计算出的辅助修正角度驱动电动汽车动力系统;若在执行步骤四中,主控制器收到卫星定位系统或中央控制室的交汇命令,则跳转执行步骤五,若在执行步骤四中,主控制器收到汽车雷达的报警信号或识别图形信号中出现大于画面设定阈值的无法辨识的数据块时,则跳转执行步骤六,若在执行步骤四中,主控制器收到卫星定位系统或中央控制室的到达终点命令,则跳转执行步骤七,所述设定阈值为人工设定参数;
步骤五:主控制器在限定时间内进行车辆交汇控制;
步骤六:主控制器放下推板,然后主控制器降低车速进行前推操作,直至识别图形信号中不出现大于画面设定阈值的无法辨识的数据块,然后重新跳转步骤四,如果智能车车体无法继续前进则主控制器控制电动汽车动力系统进行倒车操作,然后主控制器发出命令抬高伸缩杆将数字摄像头拍摄范围扩大,并根据拍摄到的画面进行画面识别和定位,如果识别图形信号中依然出现大于画面第二设定阈值的无法辨识的数据块,则主控制器发出信号至中央控制室,中央控制室进行远程控制,如果识别图形信号中未出现大于画面第二设定阈值的无法辨识的数据块,则主控制器在调整控制策略进行绕过障碍物控制;
步骤七:主控制器执行停车操作。
9.根据权利要求8所述的智能车自动行车控制方法,其特征在于:所述步骤六中进行绕过障碍物控制包括:第一阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第一预设交汇修正角度附加值计算出交汇第一阶段修正角度值,主控制器根据交汇第一阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第二阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线视为主导航轨迹线,将主导航轨迹线视为辅助导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至辅助视频识别导航模块的识别图形信号中未出现大于画面设定阈值的无法辨识的数据块,主控制器结束第二阶段,第三阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第三预设交汇修正角度附加值计算出交汇第三阶段修正角度值,主控制器根据交汇第三阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第四阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线重新视为辅助导航轨迹线,将主导航轨迹线重新视为主导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至完成突发情况设定距离的第四阶段操作,突发情况设定距离为预设值,主控制器根据横向测速线测定突发情况设定距离,第五阶段,重新跳转执行步骤四;所述的第一预设交汇修正角度附加值和第三预设交汇修正角度附加值均为带有正负的预设值;在智能车车体动作时,一旦检测到汽车雷达发出的报警信号,电动汽车动力系统动作停止动作,直到电动汽车动力系统动作解除才重新执行电动汽车动力系统动作。
10.根据权利要求8所述的智能车自动行车控制方法,其特征在于:所述的车辆交汇控制包括:第一阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第一预设交汇修正角度附加值计算出交汇第一阶段修正角度值,主控制器根据交汇第一阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第二阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线视为主导航轨迹线,将主导航轨迹线视为辅助导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至中央控制室根据交汇的辆智能车车体的卫星定位信号发出结束第二阶段命令,第三阶段,主控制器根据当前主导航轨迹线的图形信号计算出当前修正角度, 然后将当前修正角度加上第三预设交汇修正角度附加值计算出交汇第三阶段修正角度值,主控制器根据交汇第三阶段修正角度值控制电动汽车动力系统直至主控制器根据磁场信号判断智能车车体到达预设位置,第四阶段,主控制器将位于主导航轨迹线右侧的辅助导航轨迹线重新视为辅助导航轨迹线,将主导航轨迹线重新视为主导航轨迹线,主控制器根据当前视为主导航轨迹线的图形信号计算出当前修正角度,主控制器根据当前修正角度控制电动汽车动力系统直至中央控制室根据交汇的辆智能车车体的卫星定位信号发出结束第四阶段命令,第五阶段,重新跳转执行步骤四;所述限定时间为人工设定时间,所述的第一预设交汇修正角度附加值和第三预设交汇修正角度附加值均为带有正负的预设值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310511186.2A CN104062971B (zh) | 2013-10-25 | 2013-10-25 | 智能车自动行车控制系统及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310511186.2A CN104062971B (zh) | 2013-10-25 | 2013-10-25 | 智能车自动行车控制系统及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104062971A CN104062971A (zh) | 2014-09-24 |
CN104062971B true CN104062971B (zh) | 2017-04-26 |
Family
ID=51550732
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310511186.2A Active CN104062971B (zh) | 2013-10-25 | 2013-10-25 | 智能车自动行车控制系统及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104062971B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105738296B (zh) * | 2014-12-12 | 2018-07-10 | 中国农业机械化科学研究院 | 移动式白毛猪耳部颜色自动检测装置及检测方法 |
CN105725981B (zh) * | 2014-12-12 | 2019-04-23 | 中国农业机械化科学研究院 | 移动式育肥猪发热疫情自动检测装置及检测方法 |
CN106909160B (zh) * | 2015-12-23 | 2023-07-07 | 广东科达洁能股份有限公司 | 一种基于双闭环pid控制的sd型agv倒车姿态角控制装置 |
CN107688337A (zh) * | 2016-08-03 | 2018-02-13 | 苏州青飞智能科技有限公司 | 一种具有自动掉头功能的磁导航无人车系统 |
CN106708027A (zh) * | 2016-12-16 | 2017-05-24 | 盐城工学院 | 一种无人导航智能电动平车的在线图形化实时导航与控制系统 |
CN107589434A (zh) * | 2017-08-23 | 2018-01-16 | 西安中阔卫星技术应用有限责任公司 | 一种自动获取并记录实际道路标线gps坐标的装置和方法 |
CN107505943A (zh) * | 2017-09-25 | 2017-12-22 | 赵跃 | 一种自动驾驶运营车及运行方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5648904A (en) * | 1994-04-25 | 1997-07-15 | Sony Corporation | Vehicle traffic system and method |
CN101655708A (zh) * | 2008-12-05 | 2010-02-24 | 哈尔滨工业大学深圳研究生院 | 车辆智能搬运器及其控制系统和控制方法 |
CN102103379A (zh) * | 2009-12-17 | 2011-06-22 | 广州风神汽车有限公司 | 一种agv调度系统 |
CN102151634A (zh) * | 2011-03-02 | 2011-08-17 | 上海大学 | 智能树干涂白机器人 |
CN202711064U (zh) * | 2012-01-09 | 2013-01-30 | 谢朝京 | 一种agv小车引导传感装置 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US7143648B2 (en) * | 2004-09-29 | 2006-12-05 | Ferrolabs, Inc. | Magnetofluidic accelerometer with capacitive sensing of inertial body position |
-
2013
- 2013-10-25 CN CN201310511186.2A patent/CN104062971B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5648904A (en) * | 1994-04-25 | 1997-07-15 | Sony Corporation | Vehicle traffic system and method |
CN101655708A (zh) * | 2008-12-05 | 2010-02-24 | 哈尔滨工业大学深圳研究生院 | 车辆智能搬运器及其控制系统和控制方法 |
CN102103379A (zh) * | 2009-12-17 | 2011-06-22 | 广州风神汽车有限公司 | 一种agv调度系统 |
CN102151634A (zh) * | 2011-03-02 | 2011-08-17 | 上海大学 | 智能树干涂白机器人 |
CN202711064U (zh) * | 2012-01-09 | 2013-01-30 | 谢朝京 | 一种agv小车引导传感装置 |
Non-Patent Citations (1)
Title |
---|
基于磁阻传感器阵列的车辆自主导航系统研究;徐海贵;《中国博士学位论文全文数据库 工程科技辑》;20100115;正文第二章 * |
Also Published As
Publication number | Publication date |
---|---|
CN104062971A (zh) | 2014-09-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104062971B (zh) | 智能车自动行车控制系统及其控制方法 | |
CN105863351B (zh) | 一种基于智能汽车搬运机的自主泊车系统及方法 | |
WO2020233726A1 (zh) | 环境主动感知型停车场自动泊车系统 | |
CN106530820A (zh) | 一种电动汽车代客自动泊车入位充电系统 | |
CN205681168U (zh) | 一种提高电动汽车无线充电效率的系统 | |
CN207397090U (zh) | 一种无人驾驶配送小车 | |
CN103389734A (zh) | 一种智能巡逻监控小车 | |
CN105564265A (zh) | 一种电动汽车的无线充电方法及系统 | |
CN103465906A (zh) | 一种基于临场感的停车场自动停车实现方法 | |
CN208630401U (zh) | 基于电动汽车的无线充电装置 | |
CN106828203A (zh) | 无人驾驶公交车 | |
CN106347172A (zh) | 一种无人驾驶公共电动汽车系统及其使用方法 | |
CN108594824A (zh) | 一种基于视觉导航和超声波阵列的车辆编队装置和方法 | |
CN105966260A (zh) | 电动汽车无线充电自动定位装置 | |
CN106946049A (zh) | 集装箱码头流动设备自动化行走方法 | |
CN207020827U (zh) | 一种电动汽车代客自动泊车入位充电系统 | |
CN111364539A (zh) | 一种纯电驱动无人驾驶推煤机 | |
CN108407650A (zh) | 汽车无线充电方法、系统及地面侧充电系统 | |
JP2012222975A (ja) | 給電装置搭載車両 | |
CN105320141A (zh) | 一种变电站电力设备巡检方法 | |
CN107643756A (zh) | 一种无人驾驶配送小车及其行进方法 | |
CN106240705A (zh) | 一种基于灰色神经网络预测算法的前后两轮自平衡小车 | |
CN107862902A (zh) | 一种基于影像分析及对比的辅助停车系统 | |
CN213750759U (zh) | 一种基于slam技术的铁路隧道智能巡检车 | |
CN212388632U (zh) | 一种纯电驱动无人驾驶推煤机 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |