CN116811914B - 一种无人驾驶车载障碍感应系统和方法 - Google Patents
一种无人驾驶车载障碍感应系统和方法 Download PDFInfo
- Publication number
- CN116811914B CN116811914B CN202310782742.3A CN202310782742A CN116811914B CN 116811914 B CN116811914 B CN 116811914B CN 202310782742 A CN202310782742 A CN 202310782742A CN 116811914 B CN116811914 B CN 116811914B
- Authority
- CN
- China
- Prior art keywords
- obstacle
- driving route
- car
- route node
- point
- 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
- 238000000034 method Methods 0.000 title claims abstract description 21
- 230000006698 induction Effects 0.000 claims description 91
- 238000009434 installation Methods 0.000 claims description 10
- 230000001939 inductive effect Effects 0.000 claims description 3
- 230000005540 biological transmission Effects 0.000 description 13
- 238000004891 communication Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000013527 convolutional neural network Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012549 training Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出了一种无人驾驶车载障碍感应系统和方法,该方法包括以下步骤:S1,中控屏获取出发地点和终点地点;S2,中控屏获取到出发地点和终点地点后,中控屏根据获取的出发地点和终点地点生成驾驶路线;S3,轿车根据驾驶路线驾驶至终点地点。本发明能够实现轿车驾驶路线的安全驾驶。
Description
技术领域
本发明涉及一种车辆路线技术领域,特别是涉及一种无人驾驶车载障碍感应系统和方法。
背景技术
随着生活水平的提高,车辆已成为现代人生活中的重要代步工具,车辆在驾驶过程中难免会遭遇到障碍,专利申请号2021107370673,名称为“一种自动泊车环视摄像头低矮障碍物检测方法”,公开了通过车载环视摄像头采集车辆周围的图像,对图像中的低矮障碍物进行目标标注,并构建卷积神经网络构训练模型对目标标注的数据分别进行训练,获得低矮障碍物目标像素点集,通过低矮障碍物目标像素点集的做离散化处理,选择关键点,计算关键点的特征描述符,并利用特征描述符对上下两帧的关键点做匹配,并筛选出成功匹配的关键点,最后结合车辆运动信息,计算上下两图像中成功匹配上的点对Q的位置差,并根据距离差计算低矮障碍物高度,从而有效探测出低矮障碍物的类型,位置和高度信息,为自动泊车提供有效信息。该专利申请的检测手段较为复杂,不利于实施。
发明内容
本发明旨在至少解决现有技术中存在的技术问题,特别创新地提出了一种无人驾驶车载障碍感应系统和方法。
为了实现本发明的上述目的,本发明提供了一种无人驾驶车载障碍感应系统,包括轿车本体,在轿车车身上设置有M个障碍感应传感器,所述M为大于或者等于1的正整数,分别为第1障碍感应传感器、第2障碍感应传感器、第3障碍感应传感器、……、第M障碍感应传感器,第m障碍感应传感器的数据端与轿车控制器的障碍数据第m端相连,所述m为小于或者等于M的正整数,即是第1障碍感应传感器的数据端与轿车控制器的障碍数据第1端相连,第2障碍感应传感器的数据端与轿车控制器的障碍数据第2端相连,第3障碍感应传感器的数据端与轿车控制器的障碍数据第3端相连,第M障碍感应传感器的数据端与轿车控制器的障碍数据第M端相连;通过在中控屏上输入出发地点和终点地点,利用障碍感应传感器实现轿车从出发地点驾驶至终点地点。
在本发明的一种优选实施方式中,在轿车车身上设置有4个障碍感应传感器,分别为第1障碍感应传感器、第2障碍感应传感器、第3障碍感应传感器和第4障碍感应传感器;
第1障碍感应传感器安装在轿车车身前侧,用于感应轿车车身前侧是否存在障碍物;第2障碍感应传感器安装在轿车车身后侧,用于感应轿车车身后侧是否存在障碍物;第3障碍感应传感器安装在轿车车身左侧,用于感应轿车车身左侧是否存在障碍物;第4障碍感应传感器安装在轿车车身右侧,用于感应轿车车身右侧是否存在障碍物;
第1障碍感应传感器的数据端与轿车控制器的障碍数据第1端相连,第2障碍感应传感器的数据端与轿车控制器的障碍数据第2端相连,第3障碍感应传感器的数据端与轿车控制器的障碍数据第3端相连,第4障碍感应传感器的数据端与轿车控制器的障碍数据第4端相连。
在本发明的一种优选实施方式中,当第1障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第一距离阈值,则轿车控制器控制轿车避开该障碍物;
当第2障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第二距离阈值,则轿车控制器控制轿车避开该障碍物;
当第3障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第三距离阈值,则轿车控制器控制轿车避开该障碍物;
当第4障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第四距离阈值,则轿车控制器控制轿车避开该障碍物。
在本发明的一种优选实施方式中,中控屏包括壳体及设置在所述壳体上的触摸显示屏,在所述壳体内设置有用于固定安装PCB印刷线路板的PCB印刷线路板固定安装座,PCB印刷线路板固定安装在PCB印刷线路板固定安装座上,在PCB印刷线路板上设置有中控屏处理器和存储模块,中控屏处理器的数据触摸显示端与触摸显示屏的数据相连,中控屏处理器的数据存取端与存储模块的数据端相连;
在轿车本体内设置有用于固定安装中控屏的中控屏固定安装座,中控屏固定安装在中控屏固定安装座上。
本发明还公开了一种无人驾驶车载障碍感应方法,包括以下步骤:
S1,中控屏获取出发地点和终点地点;
S2,中控屏获取到出发地点和终点地点后,中控屏根据获取的出发地点和终点地点生成驾驶路线;
S3,轿车根据驾驶路线驾驶至终点地点。
在本发明的一种优选实施方式中,轿车在行驶过程中:
当第1障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第一距离阈值,则轿车控制器控制轿车避开该障碍物;
当第2障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第二距离阈值,则轿车控制器控制轿车避开该障碍物;
当第3障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第三距离阈值,则轿车控制器控制轿车避开该障碍物;
当第4障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第四距离阈值,则轿车控制器控制轿车避开该障碍物。
在本发明的一种优选实施方式中,在步骤S1中,中控屏获取出发地点和终点地点的方法包括以下步骤:
S11,中控屏判断是否在中控屏上打开了地图软件:
若在中控屏上打开了地图软件,则执行下一步;
若在中控屏上未打开地图软件,则等待在中控屏上打开地图软件,返回步骤S11;
S12,在中控屏上输入起点地点和终点地点,中控屏判断是否输入完起点地点和终点地点:
若输入完起点地点和终点地点,则执行步骤S2;
若未输入完起点地点和终点地点,则等待输入完起点地点和终点地点,执行步骤S2。
在本发明的一种优选实施方式中,在步骤S2中根据获取的出发地点和终点地点生成驾驶路线的方法包括以下步骤:
S21,在中控屏上展示地图;
S22,将出发地点和终点地点标记在地图上;
S23,搜寻出发地点所在路线上相邻的第1路线节点,分别为第1驾驶路线节点1和第1驾驶路线节点2,选择第1驾驶路线节点1或第1驾驶路线节点2作为下一个出发地点;
S24,搜寻出发地点所在路线上相邻的第2路线节点,分别为第2驾驶路线节点1、第2驾驶路线节点2、第2驾驶路线节点3、……、第2驾驶路线节点C2,C2表示第2路线节点的节点数,选择第2驾驶路线节点1或第2驾驶路线节点2或第2驾驶路线节点3或……或第2驾驶路线节点C2作为下一个出发地点;
S25,搜寻出发地点所在路线上相邻的第3路线节点,分别为第3驾驶路线节点1、第3驾驶路线节点2、第3驾驶路线节点3、……、第3驾驶路线节点C3,C3表示第3路线节点的节点数,选择第3驾驶路线节点1或第3驾驶路线节点2或第3驾驶路线节点3或……或第3驾驶路线节点C3作为下一个出发地点;
S26,搜寻出发地点所在路线上相邻的第4路线节点,分别为第4驾驶路线节点1、第4驾驶路线节点2、第4驾驶路线节点3、……、第4驾驶路线节点C4,C4表示第4路线节点的节点数,选择第4驾驶路线节点1或第4驾驶路线节点2或第4驾驶路线节点3或……或第4驾驶路线节点C4作为下一个出发地点;
……;
S27,直至搜寻到终点地点为止;搜寻到终点地点后,依次按照先后顺序将每个出发地点路线连接起来,再将终点地点路线连接起来,即得到驾驶路线。
综上所述,由于采用了上述技术方案,本发明能够实现轿车驾驶路线的安全驾驶。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1是本发明流程示意框图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。
本发明提供了一种无人驾驶车载障碍感应系统,包括轿车本体,在轿车车身上设置有M个障碍感应传感器,所述M为大于或者等于1的正整数,分别为第1障碍感应传感器、第2障碍感应传感器、第3障碍感应传感器、……、第M障碍感应传感器,第m障碍感应传感器的数据端与轿车控制器的障碍数据第m端相连,所述m为小于或者等于M的正整数,即是第1障碍感应传感器的数据端与轿车控制器的障碍数据第1端相连,第2障碍感应传感器的数据端与轿车控制器的障碍数据第2端相连,第3障碍感应传感器的数据端与轿车控制器的障碍数据第3端相连,第M障碍感应传感器的数据端与轿车控制器的障碍数据第M端相连;通过在中控屏上输入出发地点和终点地点,利用障碍感应传感器实现轿车从出发地点驾驶至终点地点。
在本发明的一种优选实施方式中,在轿车车身上设置有4个障碍感应传感器,分别为第1障碍感应传感器、第2障碍感应传感器、第3障碍感应传感器和第4障碍感应传感器;第1障碍感应传感器~第4障碍感应传感器为车载雷达。
第1障碍感应传感器安装在轿车车身前侧,用于感应轿车车身前侧是否存在障碍物;第2障碍感应传感器安装在轿车车身后侧,用于感应轿车车身后侧是否存在障碍物;第3障碍感应传感器安装在轿车车身左侧,用于感应轿车车身左侧是否存在障碍物;第4障碍感应传感器安装在轿车车身右侧,用于感应轿车车身右侧是否存在障碍物;
第1障碍感应传感器的数据端与轿车控制器的障碍数据第1端相连,第2障碍感应传感器的数据端与轿车控制器的障碍数据第2端相连,第3障碍感应传感器的数据端与轿车控制器的障碍数据第3端相连,第4障碍感应传感器的数据端与轿车控制器的障碍数据第4端相连。
在本发明的一种优选实施方式中,当第1障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第一距离阈值,则轿车控制器控制轿车避开该障碍物;
当第2障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第二距离阈值,则轿车控制器控制轿车避开该障碍物;
当第3障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第三距离阈值,则轿车控制器控制轿车避开该障碍物;避开该障碍物方法为控制轿车转向、减速等措施。
当第4障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第四距离阈值,则轿车控制器控制轿车避开该障碍物。
在本发明的一种优选实施方式中,中控屏包括壳体及设置在所述壳体上的触摸显示屏,在所述壳体内设置有用于固定安装PCB印刷线路板的PCB印刷线路板固定安装座,PCB印刷线路板固定安装在PCB印刷线路板固定安装座上,在PCB印刷线路板上设置有中控屏处理器和存储模块,存储模块中存储有地图数据,中控屏处理器的数据触摸显示端与触摸显示屏的数据相连,中控屏处理器的数据存取端与存储模块的数据端相连;通过无需联网亦可以导航。
在轿车本体内设置有用于固定安装中控屏的中控屏固定安装座,中控屏固定安装在中控屏固定安装座上。
本发明还公开了一种无人驾驶车载障碍感应方法,如图1所示,包括以下步骤:
S1,中控屏获取出发地点和终点地点;
S2,中控屏获取到出发地点和终点地点后,中控屏根据获取的出发地点和终点地点生成驾驶路线;
S3,轿车根据驾驶路线驾驶至终点地点。
在本发明的一种优选实施方式中,轿车在行驶过程中:
当第1障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第一距离阈值,则轿车控制器控制轿车避开该障碍物;
当第2障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第二距离阈值,则轿车控制器控制轿车避开该障碍物;
当第3障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第三距离阈值,则轿车控制器控制轿车避开该障碍物;
当第4障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第四距离阈值,则轿车控制器控制轿车避开该障碍物。
在本发明的一种优选实施方式中,在步骤S1中,中控屏获取出发地点和终点地点的方法包括以下步骤:
S11,中控屏判断是否在中控屏上打开了地图软件:
若在中控屏上打开了地图软件,则执行下一步;
若在中控屏上未打开地图软件,则等待在中控屏上打开地图软件,返回步骤S11;
S12,在中控屏上输入起点地点和终点地点,中控屏判断是否输入完起点地点和终点地点:
若输入完起点地点和终点地点,则执行步骤S2;
若未输入完起点地点和终点地点,则等待输入完起点地点和终点地点,执行步骤S2。
在本发明的一种优选实施方式中,在步骤S2中根据获取的出发地点和终点地点生成驾驶路线的方法包括以下步骤:
S21,在中控屏上展示地图;
S22,将出发地点和终点地点标记在地图上;
S23,搜寻出发地点(这里出发地点未处于节点)所在路线上相邻的第1路线节点,分别为第1驾驶路线节点1和第1驾驶路线节点2,选择第1驾驶路线节点1或第1驾驶路线节点2作为下一个出发地点;
S24,搜寻出发地点(这里的出发地点是处在节点上,存在两条及两条以上的选择的路线,包括本身时存在三条及三条以上的选择的路线)所在路线上相邻的第2路线节点,分别为第2驾驶路线节点1、第2驾驶路线节点2、第2驾驶路线节点3、……、第2驾驶路线节点C2,C2表示第2路线节点的节点数,选择第2驾驶路线节点1或第2驾驶路线节点2或第2驾驶路线节点3或……或第2驾驶路线节点C2作为下一个出发地点;
S25,搜寻出发地点所在路线上相邻的第3路线节点,分别为第3驾驶路线节点1、第3驾驶路线节点2、第3驾驶路线节点3、……、第3驾驶路线节点C3,C3表示第3路线节点的节点数,选择第3驾驶路线节点1或第3驾驶路线节点2或第3驾驶路线节点3或……或第3驾驶路线节点C3作为下一个出发地点;
S26,搜寻出发地点所在路线上相邻的第4路线节点,分别为第4驾驶路线节点1、第4驾驶路线节点2、第4驾驶路线节点3、……、第4驾驶路线节点C4,C4表示第4路线节点的节点数,选择第4驾驶路线节点1或第4驾驶路线节点2或第4驾驶路线节点3或……或第4驾驶路线节点C4作为下一个出发地点;
……;
S27,直至搜寻到终点地点为止;搜寻到终点地点后,依次按照先后顺序将每个出发地点路线连接起来,再将终点地点路线连接起来,即得到驾驶路线。
在本发明的一种优选实施方式中,在步骤S23中,选择第1驾驶路线节点1或第1驾驶路线节点2作为下一个出发地点的方法为:
若则选择第1驾驶路线节点1作为下一个出发地点;
其中,(x1,1,y1,1,z1,1)表示第1驾驶路线节点1的坐标点;
(x1,2,y1,2,z1,2)表示第1驾驶路线节点2的坐标点;
(x0,y0,z0)表示终点地点的坐标点;
若则选择第1驾驶路线节点2作为下一个出发地点;
其中,(x1,1,y1,1,z1,1)表示第1驾驶路线节点1的坐标点;
(x1,2,y1,2,z1,2)表示第1驾驶路线节点2的坐标点;
(x0,y0,z0)表示终点地点的坐标点;
若则选择第1驾驶路线节点1或第1驾驶路线节点2作为下一个出发地点;
其中,(x1,1,y1,1,z1,1)表示第1驾驶路线节点1的坐标点;
(x1,2,y1,2,z1,2)表示第1驾驶路线节点2的坐标点;
(x0,y0,z0)表示终点地点的坐标点。
在本发明的一种优选实施方式中,在步骤S24中,选择第2驾驶路线节点1或第2驾驶路线节点2或第2驾驶路线节点3或……或第2驾驶路线节点C2的方法为:
其中,min{}求最小值;
表示出发地点至第2驾驶路线节点c2前的坐标点;c2=1、2、3、……、C2;
(x0,y0,z0)表示终点地点的坐标点;
c′2←表示选择指向最小值所对应的第2驾驶路线节点作为下一个出发地点;
d2,1表示出发地点至第2驾驶路线节点1前的距离;
d2,2表示出发地点至第2驾驶路线节点2前的距离;
d2,3表示出发地点至第2驾驶路线节点3前的距离;
表示出发地点至第2驾驶路线节点C2前的距离。该步骤中的出发点是步骤S23中的第1驾驶路线节点1或第1驾驶路线节点2,根据步骤S23得出。
在本发明的一种优选实施方式中,在步骤S25中,选择第3驾驶路线节点1或第3驾驶路线节点2或第3驾驶路线节点3或……或第3驾驶路线节点C3的方法为:
其中,min{}求最小值;
表示出发地点至第3驾驶路线节点c3前的坐标点;c3=1、2、3、……、C3;
(x0,y0,z0)表示终点地点的坐标点;
c′3←表示选择指向最小值所对应的第3驾驶路线节点作为下一个出发地点;
d3,1表示出发地点至第3驾驶路线节点1前的距离;
d3,2表示出发地点至第3驾驶路线节点2前的距离;
d3,3表示出发地点至第3驾驶路线节点3前的距离;
表示出发地点至第3驾驶路线节点C3前的距离。该步骤中的出发点是步骤S24中的第2驾驶路线节点1或第2驾驶路线节点2或第2驾驶路线节点3或……或第2驾驶路线节点C2,根据步骤S24得出。
在本发明的一种优选实施方式中,在步骤S26中,选择第4驾驶路线节点1或第4驾驶路线节点2或第4驾驶路线节点3或……或第4驾驶路线节点C4的方法为:
其中,min{}求最小值;
表示出发地点至第4驾驶路线节点c4前的坐标点;c4=1、2、3、……、C4;
(x0,y0,z0)表示终点地点的坐标点;
c′4←表示选择指向最小值所对应的第4驾驶路线节点作为下一个出发地点;
d4,1表示出发地点至第4驾驶路线节点1前的距离;
d4,2表示出发地点至第4驾驶路线节点2前的距离;
d4,3表示出发地点至第4驾驶路线节点3前的距离;
表示出发地点至第4驾驶路线节点C4前的距离。该步骤中的出发点是步骤S25中的第3驾驶路线节点1或第3驾驶路线节点2或第3驾驶路线节点3或……或第3驾驶路线节点C3,根据步骤S25得出。
为了增强体验,在PCB印刷线路板上还设置有数据无线传输模块和定位模块,中控屏处理器的数据传输端与数据无线传输模块的数据端相连,中控屏处理器的数据定位端与定位模块的数据端相连,其中,数据无线传输模块包括3G数据无线传输模块、4G数据无线传输模块、5G数据无线传输模块之一或者任一组合;中控屏处理器的数据传输3G端与3G数据无线传输模块的数据端相连,中控屏处理器的数据传输4G端与4G数据无线传输模块的数据端相连,中控屏处理器的数据传输5G端与5G数据无线传输模块的数据端相连。其中,定位模块包括GNSS定位模块或/和GPS定位模块;中控屏处理器的数据定位GNSS端与GNSS定位模块的数据端相连,中控屏处理器的数据定位GPS端与GPS定位模块的数据端相连。此时不必输入出发地点,只需输入终点地点,具体操作可以是:
第一步,中控屏判断是否在中控屏上打开了地图软件:
若在中控屏上打开了地图软件,则中控屏自动定位中控屏的地点,将中控屏自动定位的地点作为轿车的出发地点,执行下一步;
若在中控屏上未打开地图软件,则等待在中控屏上打开地图软件,返回第一步;
第二步,在中控屏上输入终点地点,中控屏判断是否输入完终点地点:
若输入完终点地点,则执行步骤S2;
若未输入完终点地点,则等待输入完终点地点,执行步骤S2。
另外的,还可以在PCB印刷线路板上设置Bluetooth模块,中控屏处理器的数据Bluetooth端与Bluetooth模块的数据端相连,这样可以通过智能手机将输入的出发地点和终点地点传输给中控屏,具体操作可以是:
第一步,智能手机与中控屏建立蓝牙通讯,智能手机与中控屏建立蓝牙通讯后,执行下一步;
第二步,智能手机判断是否在智能手机上打开了地图软件:
若在智能手机上打开了地图软件,则智能手机自动定位智能手机的位置,将智能手机自动定位的位置作为轿车的出发地点,执行下一步;
若在智能手机上未打开地图软件,则等待在智能手机上打开地图软件,返回步骤第二步;
第三步,在智能手机上输入终点地点,智能手机判断是否输入完终点地点:
若输入完终点地点,则执行下一步;
若未输入完终点地点,则等待输入完终点地点,执行下一步;
第四步,将在智能手机上输入的终点地点和自动定位的位置传输给中控屏。
一般的,在中控屏或者智能手机上计算效率较低,通过智能手机将在智能手机上输入的终点地点和自动定位的位置传输到自驾管理平台,或者通过中控屏在中控屏上输入的终点地点和中控屏自动定位的位置传输到自驾管理平台,或者通过智能手机将在智能手机上输入的终点地点和自动定位的位置传输到中控屏,中控屏再将接收到的终点地点和出发地点传输给自驾管理平台,自驾管理平台计算出驾驶路线,具体的步骤为:
第一步,将出发地点和终点地点标记在自驾管理平台上的地图上;
第二步,搜寻出发地点所在路线上相邻的第1路线节点,分别为第1驾驶路线节点1和第1驾驶路线节点2,选择第1驾驶路线节点1或第1驾驶路线节点2作为下一个出发地点;
第三步,搜寻出发地点所在路线上相邻的第2路线节点,分别为第2驾驶路线节点1、第2驾驶路线节点2、第2驾驶路线节点3、……、第2驾驶路线节点C2,C2表示第2路线节点的节点数,选择第2驾驶路线节点1或第2驾驶路线节点2或第2驾驶路线节点3或……或第2驾驶路线节点C2作为下一个出发地点;
第四步,搜寻出发地点所在路线上相邻的第3路线节点,分别为第3驾驶路线节点1、第3驾驶路线节点2、第3驾驶路线节点3、……、第3驾驶路线节点C3,C3表示第3路线节点的节点数,选择第3驾驶路线节点1或第3驾驶路线节点2或第3驾驶路线节点3或……或第3驾驶路线节点C3作为下一个出发地点;
第五步,搜寻出发地点所在路线上相邻的第4路线节点,分别为第4驾驶路线节点1、第4驾驶路线节点2、第4驾驶路线节点3、……、第4驾驶路线节点C4,C4表示第4路线节点的节点数,选择第4驾驶路线节点1或第4驾驶路线节点2或第4驾驶路线节点3或……或第4驾驶路线节点C4作为下一个出发地点;
……;
第六步,直至搜寻到终点地点为止;搜寻到终点地点后,依次按照先后顺序将每个出发地点路线连接起来,再将终点地点路线连接起来,即得到驾驶路线;
第七步,将驾驶路线传输给中控屏,在中控屏上展示驾驶路线。
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。
Claims (6)
1.一种无人驾驶车载障碍感应系统,包括轿车本体,在轿车车身上设置有M个障碍感应传感器,所述M为大于或者等于1的正整数,分别为第1障碍感应传感器、第2障碍感应传感器、第3障碍感应传感器、……、第M障碍感应传感器,第m障碍感应传感器的数据端与轿车控制器的障碍数据第m端相连,所述m为小于或者等于M的正整数,其特征在于,通过在中控屏上输入出发地点和终点地点,利用障碍感应传感器实现轿车从出发地点驾驶至终点地点,通过在中控屏上输入出发地点和终点地点,利用障碍感应传感器实现轿车从出发地点驾驶至终点地点的方法包括以下步骤:
S1,中控屏获取出发地点和终点地点;
S2,中控屏获取到出发地点和终点地点后,中控屏根据获取的出发地点和终点地点生成驾驶路线;根据获取的出发地点和终点地点生成驾驶路线的方法包括以下步骤:
S21,在中控屏上展示地图;
S22,将出发地点和终点地点标记在地图上;
S23,搜寻出发地点所在路线上相邻的第1路线节点,分别为第1驾驶路线节点1和第1驾驶路线节点2,选择第1驾驶路线节点1或第1驾驶路线节点2作为下一个出发地点;选择第1驾驶路线节点1或第1驾驶路线节点2作为下一个出发地点的方法为:
若则选择第1驾驶路线节点1作为下一个出发地点;
其中,(x1,1,y1,1,z1,1)表示第1驾驶路线节点1的坐标点;
(x1,2,y1,2,z1,2)表示第1驾驶路线节点2的坐标点;
(x0,y0,z0)表示终点地点的坐标点;
若则选择第1驾驶路线节点2作为下一个出发地点;
其中,(x1,1,y1,1,z1,1)表示第1驾驶路线节点1的坐标点;
(x1,2,y1,2,z1,2)表示第1驾驶路线节点2的坐标点;
(x0,y0,z0)表示终点地点的坐标点;
若则选择第1驾驶路线节点1或第1驾驶路线节点2作为下一个出发地点;
其中,(x1,1,y1,1,z1,1)表示第1驾驶路线节点1的坐标点;
(x1,2,y1,2,z1,2)表示第1驾驶路线节点2的坐标点;
(x0,y0,z0)表示终点地点的坐标点;
S24,搜寻出发地点所在路线上相邻的第2路线节点,分别为第2驾驶路线节点1、第2驾驶路线节点2、第2驾驶路线节点3、……、第2驾驶路线节点C2,C2表示第2路线节点的节点数,选择第2驾驶路线节点1或第2驾驶路线节点2或第2驾驶路线节点3或……或第2驾驶路线节点C2作为下一个出发地点;
S25,搜寻出发地点所在路线上相邻的第3路线节点,分别为第3驾驶路线节点1、第3驾驶路线节点2、第3驾驶路线节点3、……、第3驾驶路线节点C3,C3表示第3路线节点的节点数,选择第3驾驶路线节点1或第3驾驶路线节点2或第3驾驶路线节点3或……或第3驾驶路线节点C3作为下一个出发地点;
S26,搜寻出发地点所在路线上相邻的第4路线节点,分别为第4驾驶路线节点1、第4驾驶路线节点2、第4驾驶路线节点3、……、第4驾驶路线节点C4,C4表示第4路线节点的节点数,选择第4驾驶路线节点1或第4驾驶路线节点2或第4驾驶路线节点3或……或第4驾驶路线节点C4作为下一个出发地点;
……;
S27,直至搜寻到终点地点为止;搜寻到终点地点后,依次按照先后顺序将每个出发地点路线连接起来,再将终点地点路线连接起来,即得到驾驶路线;
S3,轿车根据驾驶路线驾驶至终点地点。
2.根据权利要求1所述的无人驾驶车载障碍感应系统,其特征在于,在轿车车身上设置有4个障碍感应传感器,分别为第1障碍感应传感器、第2障碍感应传感器、第3障碍感应传感器和第4障碍感应传感器;
第1障碍感应传感器安装在轿车车身前侧,用于感应轿车车身前侧是否存在障碍物;第2障碍感应传感器安装在轿车车身后侧,用于感应轿车车身后侧是否存在障碍物;第3障碍感应传感器安装在轿车车身左侧,用于感应轿车车身左侧是否存在障碍物;第4障碍感应传感器安装在轿车车身右侧,用于感应轿车车身右侧是否存在障碍物;
第1障碍感应传感器的数据端与轿车控制器的障碍数据第1端相连,第2障碍感应传感器的数据端与轿车控制器的障碍数据第2端相连,第3障碍感应传感器的数据端与轿车控制器的障碍数据第3端相连,第4障碍感应传感器的数据端与轿车控制器的障碍数据第4端相连。
3.根据权利要求1所述的无人驾驶车载障碍感应系统,其特征在于,当第1障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第一距离阈值,则轿车控制器控制轿车避开该障碍物;
当第2障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第二距离阈值,则轿车控制器控制轿车避开该障碍物;
当第3障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第三距离阈值,则轿车控制器控制轿车避开该障碍物;
当第4障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第四距离阈值,则轿车控制器控制轿车避开该障碍物。
4.根据权利要求1所述的无人驾驶车载障碍感应系统,其特征在于,中控屏包括壳体及设置在所述壳体上的触摸显示屏,在所述壳体内设置有用于固定安装PCB印刷线路板的PCB印刷线路板固定安装座,PCB印刷线路板固定安装在PCB印刷线路板固定安装座上,在PCB印刷线路板上设置有中控屏处理器和存储模块,中控屏处理器的数据触摸显示端与触摸显示屏的数据相连,中控屏处理器的数据存取端与存储模块的数据端相连;
在轿车本体内设置有用于固定安装中控屏的中控屏固定安装座,中控屏固定安装在中控屏固定安装座上。
5.根据权利要求1所述的无人驾驶车载障碍感应系统,其特征在于,在步骤S3中,轿车在行驶过程中:
当第1障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第一距离阈值,则轿车控制器控制轿车避开该障碍物;
当第2障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第二距离阈值,则轿车控制器控制轿车避开该障碍物;
当第3障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第三距离阈值,则轿车控制器控制轿车避开该障碍物;
当第4障碍感应传感器检测到障碍物距离轿车距离小于或者等于预设第四距离阈值,则轿车控制器控制轿车避开该障碍物。
6.根据权利要求1所述的无人驾驶车载障碍感应系统,其特征在于,在步骤S1中,中控屏获取出发地点和终点地点的方法包括以下步骤:
S11,中控屏判断是否在中控屏上打开了地图软件:
若在中控屏上打开了地图软件,则执行下一步;
若在中控屏上未打开地图软件,则等待在中控屏上打开地图软件,返回步骤S11;
S12,在中控屏上输入起点地点和终点地点,中控屏判断是否输入完起点地点和终点地点:
若输入完起点地点和终点地点,则执行步骤S2;
若未输入完起点地点和终点地点,则等待输入完起点地点和终点地点,执行步骤S2。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310782742.3A CN116811914B (zh) | 2023-06-29 | 2023-06-29 | 一种无人驾驶车载障碍感应系统和方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310782742.3A CN116811914B (zh) | 2023-06-29 | 2023-06-29 | 一种无人驾驶车载障碍感应系统和方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN116811914A CN116811914A (zh) | 2023-09-29 |
CN116811914B true CN116811914B (zh) | 2024-07-19 |
Family
ID=88125430
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310782742.3A Active CN116811914B (zh) | 2023-06-29 | 2023-06-29 | 一种无人驾驶车载障碍感应系统和方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN116811914B (zh) |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107765685A (zh) * | 2016-08-19 | 2018-03-06 | 德韧营运有限责任公司 | 用于机动车辆的自动辅助泊车系统的路径控制方法 |
CN111976741A (zh) * | 2019-05-23 | 2020-11-24 | 现代自动车株式会社 | 用于控制自动驾驶车辆的装置和方法 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SE537265C2 (sv) * | 2013-03-19 | 2015-03-17 | Scania Cv Ab | Reglersystem samt metod för reglering av fordon vid detektion av hinder |
US10466709B2 (en) * | 2013-11-08 | 2019-11-05 | Hitachi, Ltd. | Autonomous driving vehicle and autonomous driving system |
US9771055B1 (en) * | 2016-11-01 | 2017-09-26 | GM Global Technology Operations LLC | Front impact mitigation system for a vehicle and method |
JP6972793B2 (ja) * | 2017-09-04 | 2021-11-24 | 日産自動車株式会社 | 運転支援車両の走行制御方法及び走行制御装置 |
KR102151811B1 (ko) * | 2018-01-26 | 2020-09-03 | 충북대학교 산학협력단 | 회피경로 생성방법 및 그를 위한 장치 |
DE102018204006A1 (de) * | 2018-03-15 | 2019-09-19 | Robert Bosch Gmbh | Verfahren und System zur sicheren Kollisionsvermeidung von infrastrukturseitig überwachten Fahrzeugen |
CN112805196A (zh) * | 2018-10-03 | 2021-05-14 | 三菱电机株式会社 | 停车辅助装置及停车辅助方法 |
KR102178992B1 (ko) * | 2018-12-21 | 2020-11-17 | 충북대학교 산학협력단 | 차량 동작 계획방법 및 그를 위한 장치 |
US11487293B2 (en) * | 2020-11-20 | 2022-11-01 | Automotive Research & Testing Center | Map-information obstacle-tracking system and method |
KR20220097695A (ko) * | 2020-12-30 | 2022-07-08 | 현대자동차주식회사 | 인지센서 기반의 자율주차 경로 탐색 시스템 및 방법 |
US11892832B2 (en) * | 2021-06-16 | 2024-02-06 | Waymo Llc | Lane path modification framework |
CN113741453B (zh) * | 2021-08-31 | 2024-06-25 | 广州文远知行科技有限公司 | 一种非结构化环境的路径规划方法、装置、设备和介质 |
JP2023064009A (ja) * | 2021-10-25 | 2023-05-10 | パナソニックIpマネジメント株式会社 | 車両制御装置、車両、車両制御方法および車両制御プログラム |
JP7308900B2 (ja) * | 2021-10-27 | 2023-07-14 | 三菱電機株式会社 | 車両の走行制御処理システム |
CN114715188A (zh) * | 2022-03-25 | 2022-07-08 | 苏州鉴智机器人科技有限公司 | 车辆自动驾驶控制系统及车辆 |
-
2023
- 2023-06-29 CN CN202310782742.3A patent/CN116811914B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107765685A (zh) * | 2016-08-19 | 2018-03-06 | 德韧营运有限责任公司 | 用于机动车辆的自动辅助泊车系统的路径控制方法 |
CN111976741A (zh) * | 2019-05-23 | 2020-11-24 | 现代自动车株式会社 | 用于控制自动驾驶车辆的装置和方法 |
Also Published As
Publication number | Publication date |
---|---|
CN116811914A (zh) | 2023-09-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7192443B2 (ja) | 情報提供システム、サーバ、車載装置、車両、プログラム及び情報提供方法 | |
JP6368651B2 (ja) | 走行環境認識システム | |
US20220274588A1 (en) | Method for automatically parking a vehicle | |
CN102141797B (zh) | 航站楼服务机器人及其控制方法 | |
CN107933548A (zh) | 一种自动泊车的车位识别方法及系统 | |
CN111292351A (zh) | 车辆检测方法及执行其的电子设备 | |
CN105916758A (zh) | 用于车辆的自主泊车的方法、用于执行所述方法的驾驶员辅助设备以及具有所述驾驶员辅助设备的车辆 | |
CN118038405A (zh) | 识别自动驾驶车辆的分配的乘客 | |
CN105676741B (zh) | 基于物联网技术的物流通道远程控制系统 | |
JP2009276927A (ja) | 空き駐車スペース情報送信装置および空き駐車スペース案内システム | |
KR20140078158A (ko) | 카메라를 이용한 추측항법 기반 네비게이션 시스템 및 그 제어방법 | |
US20140327557A1 (en) | Display method and display system for a vehicle | |
KR20120094397A (ko) | 자동차용 카메라 모듈 및 이를 이용한 주차 유도 방법 | |
CN109196437A (zh) | 智能驾驶方法、装置及存储介质 | |
JP2017226371A (ja) | 走行情報表示システムおよび走行情報表示プログラム | |
US20220276648A1 (en) | Mobile object control system, mobile object, mobile object control method, and storage medium | |
CN116811914B (zh) | 一种无人驾驶车载障碍感应系统和方法 | |
WO2014167809A1 (ja) | ドライバ情報表示装置、ドライバ情報表示プログラム製品、ドライバ情報表示方法 | |
KR20220157494A (ko) | 자율 주행 방법 및 디바이스 | |
US20230252804A1 (en) | Learning method, learning device, mobile object control device, mobile object control method, and storage medium | |
JP2009026209A (ja) | 自律移動装置 | |
JP4844812B2 (ja) | 車両間情報通信システム | |
CN113135179A (zh) | 泊车检测方法、装置、设备、系统及存储介质 | |
JP4725310B2 (ja) | 車車間通信システム | |
CN113696909A (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 |