一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

移动体控制装置、移动体控制方法及存储介质与流程

2021-10-23 01:20:00 来源:中国专利 TAG:控制 装置 方法 存储介质


1.本发明涉及移动体控制装置、移动体控制方法及存储介质。


背景技术:

2.使车辆自主地行驶(以下称作自动驾驶(automated driving))的研究及实用化不断进展(专利文献1)。
3.【在先技术文献】
4.【专利文献】
5.专利文献1:日本特开2020

42853号公报


技术实现要素:

6.发明要解决的课题
7.在自动驾驶中,与控制系统的可靠性相关的要求非常高。因此,优选的是,即使在无明确的故障的情况下也进行某些异常判定,早期地进行维修、修理。该点并不限于车辆,关于自主地移动的移动体的移动控制也同样。
8.本发明是考虑这样的情况而完成的,其目的之一在于提供能够早期地进行控制系统的异常判定的移动体控制装置、移动体控制方法及存储介质。
9.用于解决课题的方案
10.本发明的移动体控制装置、移动体控制方法及存储介质采用了以下的结构。
11.(1):本发明的一方案的移动体控制装置具备:识别部,其识别移动体的周边的物体及行驶路形状;移动控制部,其基于所述识别部的识别结果来生成目标轨道,并使所述移动体沿所述目标轨道自主地行驶;以及判定部,在基准目标轨道与所述移动体的位置之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第一规定时间以上的情况下,判定为包括所述识别部及所述移动控制部在内的控制系统发生了异常,并输出判定结果,所述基准目标轨道根据由所述识别部识别出的行驶路形状来确定,且作为所述移动控制部生成所述目标轨道的基准。
12.(2):本发明的另一方案是一种移动体控制装置,其中,所述移动体控制装置具备:识别部,其识别移动体的周边的物体及行驶路形状;移动控制部,其基于所述识别部的识别结果来生成目标轨道,并使所述移动体沿所述目标轨道自主地行驶;以及判定部,其在基准目标轨道与所述目标轨道之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第二规定时间以上的情况下,判定为包括所述识别部及所述移动控制部在内的控制系统发生了异常,并输出判定结果,所述基准目标轨道根据由所述识别部识别到的行驶路形状来确定,且作为所述移动控制部生成所述目标轨道的基准。
13.(3):在上述(1)或(2)的方案中,所述移动控制部在由从上空观察所述移动体的周边的空间时的二维平面表示的设想平面中,至少基于由所述识别部识别到的物体的存在来设定表示所述移动体不应该接近的程度的指标值即风险,并以通过所述风险低的地点的方
式生成所述目标轨道,所述判定部在所述目标轨道的各地点的基于所述物体的存在所引起的风险的值而得到的风险程度为基准程度以上的情况下,停止判定为发生了所述异常。
14.(4):在上述(1)至(3)中的任一方案中,所述判定部取得所述移动体的周边的环境信息,并在所述环境信息满足规定条件的情况下,设置为不易判定为发生了所述异常。
15.(5):在上述(1)至(4)中的任一方案中,所述判定部取得所述移动体的速度,并在所述速度比基准速度高的情况下,设置为不易判定为发生了所述异常。
16.(6):在上述(1)至(5)中的任一方案中,所述判定部按所述移动体的每个速度区域收集数据,并按所述移动体的每个速度区域来判定包括所述识别部及所述移动控制部在内的控制系统是否发生了异常。
17.(7):本发明的另一方案是一种移动体控制方法,其中,所述移动体控制方法使计算机进行如下处理:识别移动体的周边的物体及行驶路形状;基于所述识别的结果来生成目标轨道;使所述移动体沿所述目标轨道自主地行驶;在基准目标轨道与所述移动体的位置之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第一规定时间以上的情况下,判定为控制系统发生了异常,并输出判定结果,所述基准目标轨道根据所述识别的行驶路形状来确定,且作为生成所述目标轨道的基准。
18.(8):本发明的又一方案是一种移动体控制方法,其中,所述移动体控制方法使计算机进行如下处理:识别移动体的周边的物体及行驶路形状;基于所述识别的结果来生成目标轨道;使所述移动体沿所述目标轨道自主地行驶;在基准目标轨道与所述目标轨道之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第二规定时间以上的情况下,判定为进行所述识别且使所述移动体自主地行驶的控制系统发生了异常,并输出判定结果,所述基准目标轨道根据所述识别的行驶路形状来确定,且作为生成所述目标轨道的基准。
19.(9):本发明的再一方案是一种存储介质,其存储有程序,其中,所述程序使计算机进行如下处理:识别移动体的周边的物体及行驶路形状;基于所述识别的结果来生成目标轨道;使所述移动体沿所述目标轨道自主地行驶;在基准目标轨道与所述移动体的位置之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第一规定时间以上的情况下,判定为进行所述识别且使所述移动体自主地行驶的控制系统发生了异常,并输出判定结果,所述基准目标轨道根据所述识别的行驶路形状来确定,且作为生成所述目标轨道的基准。
20.(10):本发明的再一方案是一种存储介质,其存储有程序,其中,
21.所述程序使计算机进行如下处理:识别移动体的周边的物体及行驶路形状;基于所述识别的结果来生成目标轨道;使所述移动体沿所述目标轨道自主地行驶;在基准目标轨道与所述目标轨道之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第二规定时间以上的情况下,判定为进行所述识别且使所述移动体自主地行驶的控制系统发生了异常,并输出判定结果,所述基准目标轨道根据所述识别的行驶路形状来确定,且作为生成所述目标轨道的基准。
22.发明效果
23.根据上述(1)~(10)的方案,能够早期地进行控制系统的异常判定。
附图说明
24.图1是利用了实施方式的移动体控制装置的车辆系统1的结构图。
25.图2是自动驾驶控制装置100的功能结构图。
26.图3是表示由风险分布预测部135设定的风险的概要的图。
27.图4是表示图3的4

4线处的第一风险r1和第二风险r2的值的图。
28.图5是用于说明目标轨道生成部145的处理的第一图。
29.图6是用于说明目标轨道生成部145的处理的第二图。
30.图7是表示基准目标轨道与本车辆m的位置偏离、且之后吻合的情形的图。
31.图8是表示基准目标轨道与目标轨道偏离、且之后吻合的情形的图。
32.图9是表示实施方式的自动驾驶控制装置100的硬件结构的一例的图。
具体实施方式
33.以下,参照附图来说明本发明的移动体控制装置、移动体控制方法及存储介质的实施方式。移动体是指车辆、自主步行机器人、无人机等能够通过自身所具备的驱动机构而自主地移动的构造体。在以下的说明中,以移动体是在地上移动的车辆为前提,专门说明用于使车辆在地上移动的结构及功能,但在移动体是无人机等飞翔体的情况下,飞翔体可以具备用于在三维空间移动的结构及功能。
34.<第一实施方式>
35.[整体结构]
[0036]
图1是利用了实施方式的移动体控制装置的车辆系统1的结构图。搭载车辆系统1的车辆例如是二轮、三轮、四轮等的车辆,其驱动源是柴油发动机、汽油发动机等内燃机、电动机、或者它们的组合。电动机使用由与内燃机连结的发电机发出的发电电力、或者二次电池、燃料电池的放电电力来进行动作。
[0037]
车辆系统1例如具备相机10、雷达装置12、lidar(light detection and ranging)14、物体识别装置16、通信装置20、hmi(human machine interface)30、车辆传感器40、导航装置50、mpu(map positioning unit)60、驾驶操作件80、自动驾驶控制装置100、行驶驱动力输出装置200、制动装置210及转向装置220。这些装置、设备通过can(controller area network)通信线等多路通信线、串行通信线、无线通信网等而互相连接。需要说明的是,图1所示的结构只是一例,可以省略结构的一部分,也可以还追加别的结构。
[0038]
相机10例如是利用了ccd(charge coupled device)、cmos(complementary metal oxide semiconductor)等固体摄像元件的数码相机。相机10安装于搭载车辆系统1的车辆(以下称作本车辆m)的任意部位。在对前方进行拍摄的情况下,相机10安装于前风窗玻璃上部、车室内后视镜背面等。相机10例如周期性地反复对本车辆m的周边进行拍摄。相机10也可以是立体相机。
[0039]
雷达装置12向本车辆m的周边放射毫米波等电波,并且检测由物体反射的电波(反射波)来至少检测物体的位置(距离及方位)。雷达装置12安装于本车辆m的任意部位。雷达装置12也可以通过fm

cw(frequency modulated continuous wave)方式来检测物体的位置及速度。
[0040]
lidar14向本车辆m的周边照射光(或与光接近的波长的电磁波),并测定散射光。
lidar14基于从发光到受光的时间,来检测到达对象的距离。照射的光例如是脉冲状的激光。lidar14安装于本车辆m的任意部位。
[0041]
物体识别装置16对由相机10、雷达装置12及lidar14中的一部分或全部检测的检测结果进行传感器融合处理,来识别物体的位置、种类、速度等。物体识别装置16将识别结果向自动驾驶控制装置100输出。物体识别装置16可以将相机10、雷达装置12及lidar14的检测结果直接向自动驾驶控制装置100输出。也可以从车辆系统1省略物体识别装置16。
[0042]
通信装置20例如利用蜂窝网、wi

fi网、bluetooth(注册商标)、dsrc(dedicated short range communication)等,来与存在于本车辆m的周边的其他车辆通信,或者经由无线基站而与各种服务器装置通信。
[0043]
hmi30对本车辆m的乘员提示各种信息,并且接受由乘员进行的输入操作。hmi30包括各种显示装置、扬声器、蜂鸣器、触摸面板、开关、按键等。
[0044]
车辆传感器40包括检测本车辆m的速度的车速传感器、检测加速度的加速度传感器、检测绕铅垂轴的角速度的横摆角速度传感器、检测本车辆m的朝向的方位传感器等。
[0045]
导航装置50例如具备gnss(global navigation satellite system)接收机51、导航hmi52、路径决定部53。导航装置50在hdd(hard diskdrive)、闪存器等存储装置中保持有第一地图信息54。gnss接收机51基于从gnss卫星接收到的信号来确定本车辆m的位置。本车辆m的位置也可以由利用了车辆传感器40的输出的ins(inertial navigation system)确定或补充。导航hmi52包括显示装置、扬声器、触摸面板、按键等。导航hmi52也可以一部或全部与前述的hmi30共用化。路径决定部53例如参照第一地图信息54来决定从由gnss接收机51确定的本车辆m的位置(或者输入的任意的位置)到由乘员使用导航hmi52而输入的目的地为止的路径(以下称作地图上路径)。第一地图信息54例如是通过表示道路的路段和由路段连接的节点来表现行驶路形状的信息。第一地图信息54也可以包括道路的曲率、poi(point of interest)信息等。地图上路径向mpu60输出。导航装置50也可以基于地图上路径来进行使用了导航hmi52的路径引导。导航装置50例如也可以通过乘员持有的智能手机、平板终端等终端装置的功能来实现。导航装置50也可以经由通信装置20向导航服务器发送当前位置和目的地,并从导航服务器取得与地图上路径同等的路径。
[0046]
mpu60例如包括推荐车道决定部61,在hdd、闪存器等存储装置中保持有第二地图信息62。推荐车道决定部61将从导航装置50提供的地图上路径分割为多个区块(例如在车辆行进方向上按每100[m]进行分割),并参照第二地图信息62而按每个区块决定推荐车道。推荐车道决定部61进行在从左数第几个车道上行驶这样的决定。推荐车道决定部61在地图上路径存在分支部位的情况下,决定推荐车道以使本车辆m能够在用于向分支目的地行进的合理的路径上行驶。
[0047]
第二地图信息62是比第一地图信息54高精度的地图信息。第二地图信息62例如包括车道的中央的信息或车道的边界的信息等。另外,第二地图信息62中也可以包括道路信息、交通限制信息、住所信息(住所、邮政编码)、设施信息、电话号码信息等。第二地图信息62也可以通过通信装置20与其他装置通信而随时被更新。
[0048]
驾驶操作件80例如包括油门踏板、制动踏板、换挡杆、转向盘、异形转向器、操纵杆、其他操作件。在驾驶操作件80上安装有检测操作量或操作的有无的传感器,其检测结果向自动驾驶控制装置100、或者行驶驱动力输出装置200、制动装置210及转向装置220中的
一部分或全部输出。
[0049]
自动驾驶控制装置100例如具备第一控制部120和第二控制部180。第一控制部120和第二控制部180分别例如通过cpu(central processing unit)等硬件处理器执行程序(软件)来实现。另外,这些构成要素中的一部分或全部可以通过lsi(large scale integration)、asic(application specific integrated circuit)、fpga(field

programmable gate array)、gpu(graphics processing unit)等硬件(包含电路部:circuitry)来实现,也可以通过软件与硬件的协同配合来实现。程序可以预先保存于自动驾驶控制装置100的hdd、闪存器等存储装置(具备非暂时性的存储介质的存储装置),也可以保存于dvd、cd

rom等能够装卸的存储介质,并通过存储介质(非暂时性的存储介质)装配于驱动装置装配而安装于自动驾驶控制装置100的hdd、闪存器。自动驾驶控制装置100是“移动体控制装置”的一例。另外,至少第一控制部120是“控制系统”的一例。“控制系统”也可以包括第二控制部180。
[0050]
图2是自动驾驶控制装置100的功能结构图。第一控制部120例如具备识别部130、风险分布预测部135、行动计划生成部140及异常判定部150。将风险分布预测部135、行动计划生成部140及第二控制部180合起来是“移动控制部”的一例。异常判定部150是判定部”的一例。
[0051]
识别部130基于从相机10、雷达装置12及lidar14经由物体识别装置16而输入的信息,来识别处于本车辆m的周边的物体的位置、速度、加速度等状态。物体的位置例如被识别为以本车辆m的代表点(重心、驱动轴中心等)为原点的绝对坐标上的位置,并使用于控制。物体的位置可以通过该物体的重心、角部等代表点来表示,也可以通过表现出的区域来表示。物体的“状态”也可以包括物体的加速度、加加速度、或者“行动状态”(例如是否正进行车道变更或要进行车道变更)。
[0052]
另外,识别部130例如识别本车辆m行驶着的车道(行驶车道)。例如,识别部130将从第二地图信息62得到的道路划分线的图案(例如实线与虚线的排列)与根据由相机10拍摄到的图像而识别出的本车辆m的周边的道路划分线的图案进行比较,由此识别行驶车道。需要说明的是,识别部130不限于识别道路划分线,也可以通过识别道路划分线、包括路肩、缘石、中央隔离带、护栏等在内的行驶路边界,来识别行驶车道。在该识别中,也可以加进从导航装置50取得的本车辆m的位置、由ins处理的处理结果。另外,识别部130识别暂时停止线、障碍物、红灯、收费站、其他道路现象。
[0053]
识别部130在识别行驶车道时,识别本车辆m相对于行驶车道的位置、姿态。识别部130例如也可以识别本车辆m的基准点从车道中央的偏离、以及本车辆m的行进方向相对于将车道中央相连的线所成的角度,来作为本车辆m相对于行驶车道的相对位置及姿态。也可以代替于此,识别部130识别本车辆m的基准点相对于行驶车道的任意侧端部(道路划分线或道路边界)的位置等,来作为本车辆m相对于行驶车道的相对位置。
[0054]
风险分布预测部135在由从上空观察本车辆m的周边的空间时的二维平面表示的设想平面s中,设定表示本车辆m不应该进入乃至不应该接近的程度的指标值即风险。换言之,风险表示物体目标(不仅包括物体,也包括路肩、护栏、白线外区域等不可行驶区域)的存在概率(也可以不是严格意义上的“概率”)。关于风险,值越大则表示本车辆m越不应该进入乃至不应该接近,值越接近零则表示本车辆m越优选行驶。但是,该关系也可以相反。
[0055]
风险分布预测部135如针对当前时刻t、δt后(时刻t δt)、2δt后(时刻t 2δt)、...这样设定设想平面s中的风险,即不仅针对当前时间点进行设定,也针对以恒定的时间间隔规定的将来的各时间点进行设定。风险分布预测部135基于由识别部130持续地识别着的移动物体目标的位置的变化来预测将来的各时间点的风险。
[0056]
图3是表示由风险分布预测部135设定的风险的概要的图。风险分布预测部135针对车辆、行人、自行车等交通参加者(物体),在设想平面s上设定使基于行进方向及速度得出的椭圆乃至于圆为等高线的第一风险。另外,风险分布预测部135基于由识别部130识别到的行驶路形状来设定基准目标轨道。例如若是直行路,则风险分布预测部135在车道的中央设定基准目标轨道,若是弯路,则风险分布预测部135在车道的中央附近设定圆弧状的基准目标轨道。风险分布预测部135设定第二风险,该设定第二风险在基准目标轨道的位置为最小值,随着从基准目标轨道离开并去往不可行驶区域而值变大,当到达不可行驶区域时成为恒定值的。在图中,dm是本车辆m的行进方向,kr是基准目标轨道。r1(m1)是停止车辆m1的第一风险,r1(p)是行人p的第一风险。行人p正沿着横穿道路的方向移动,因此针对将来的各时间点而在与当前时刻不同的位置设定第一风险。关于正在移动的车辆、自行车等也同样。r2是第二风险。在图中,影线浓度表示风险的值,影线越浓则表示风险越大。图4是表示图3的4

4线处的第一风险r1和第二风险r2的值的图。
[0057]
行动计划生成部140具备目标轨道生成部145。目标轨道生成部145以原则上在由推荐车道决定部61决定的推荐车道上行驶、且通过由风险分布预测部135设定的风险(加上了第一风险r1和第二风险r2而得到的风险)小的地点的方式,生成本车辆m自主地(不依赖于驾驶员的操作地)将来行驶的目标轨道。目标轨道例如包括速度要素。例如,目标轨道表现为将本车辆m应该到达的多个地点(轨道点)从距本车辆m近的地点开始依次排列而成的轨道。轨道点是按沿途距离计每隔规定的行驶距离(例如数[m]程度)的本车辆m应该到达的地点,有别于此,每隔规定的采样时间(例如零点几[sec]程度)的目标速度及目标加速度作为目标轨道的一部分而生成。轨道点也可以是每隔规定的采样时间的在该采样时刻本车辆m应该到达的位置。在该情况下,目标速度、目标加速度的信息由轨道点的间隔表现。行动计划生成部140生成多个目标轨道的候补,并分别计算基于效率性、安全性的观点得到的得分,并将得分良好的目标轨道的候补选择为目标轨道。在以下的说明中,有时将作为轨道点的集合的目标轨道仅以直线、虚线等形式图示。
[0058]
目标轨道生成部145基于本车辆m的位置及姿态和基准目标轨道反复生成目标轨道。图5是用于说明目标轨道生成部145的处理的第一图。在图5的例子中,不存在产生第一风险r1的物体,因此目标轨道生成部145专门考虑第二风险r2来生成目标轨道。在图中,k是目标轨道,kp是轨道点。在该状态下,本车辆m偏置于行驶车道的比中央靠左侧的位置、且相对于行驶车道的延伸方向而向右倾斜。目标轨道生成部145以靠近第二风险r2小的基准目标轨道kr上的地点、且避免急转弯、加减速的方式,生成目标轨道k。其结果是,目标轨道k成为在描绘平滑的曲线的同时向基准目标轨道kr收敛的形态。这样,基准目标轨道kr成为生成目标轨道k时的基准。
[0059]
在存在产生第一风险r1的物体的情况下,目标轨道k成为与图5的形态不同的形态。图6是用于说明目标轨道生成部145的处理的第二图。在图6的例子中,第一风险r1给目标轨道k的形态带来影响。即,目标轨道k以躲避停止车辆m1的附近的方式向右绕过并迂回
而生成。需要说明的是,行人p所引起的第一风险r1(p)比本车辆m的通过晚地接近本车辆m的行驶车道,因此不会给目标轨道k带来影响。
[0060]
关于异常判定部150的功能,见后述。
[0061]
第二控制部180基于由第一控制部120生成的目标轨道,来控制行驶驱动力输出装置200、制动装置210及转向装置220。另外,第二控制部180在从驾驶操作件80输入了超过基准的操作量的信息的情况下,使基于第一控制部120的自动驾驶停止而切换为手动驾驶。
[0062]
行驶驱动力输出装置200将用于使车辆行驶的行驶驱动力(转矩)向驱动轮输出。行驶驱动力输出装置200例如具备内燃机、电动机及变速器等的组合、以及控制它们的ecu(electronic control unit)。ecu按照从第二控制部180输入的信息或从驾驶操作件80输入的信息,来控制上述的结构。
[0063]
制动装置210例如具备制动钳、向制动钳传递液压的液压缸、使液压缸产生液压的电动马达、以及制动ecu。制动ecu按照从第一控制部120输入的信息、或者从驾驶操作件80输入的信息来控制电动马达,以使与制动操作相应的制动转矩向各车轮输出。制动装置210可以具备将通过驾驶操作件80所包含的制动踏板的操作产生的液压经由主液压缸向液压缸传递的机构作为备用。需要说明的是,制动装置210不限于上述说明的结构,也可以是按照从第二控制部180输入的信息来控制致动器,从而将主液压缸的液压向液压缸传递的电子控制式液压制动装置。
[0064]
转向装置220例如具备转向ecu和电动马达。电动马达例如使力作用于齿条

小齿轮机构来变更转向轮的朝向。转向ecu按照从第二控制部180输入的信息、或者从驾驶操作件80输入的信息,来驱动电动马达,使转向轮的朝向变更。
[0065]
[异常判定]
[0066]
以下,说明由异常判定部150进行的处理的内容。异常判定部150通过以下说明的处理,来判定控制系统是否发生了异常。异常判定部150在基准目标轨道与本车辆m的位置之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第一规定时间以上的情况下,判定为控制系统发生了异常,该基准目标轨道通过由识别部130识别到的行驶路形状来确定、且是目标轨道生成部145生成目标轨道的基准。异常判定部150在判定为控制系统发生了异常的情况下,使hmi30输出催促本车辆m的维修、检查的信息。所谓本车辆m的位置,是指如前述那样本车辆m的代表点的位置。所谓“吻合”,是指在机动车的行驶控制的领域中在能够视作误差的规定范围内不同。以下,将规定规定范围的长度称作基准距离l1。基准距离l1例如是30[cm]左右的长度。
[0067]
图7是表示基准目标轨道与本车辆m的位置发生偏离且之后吻合的情形的图。在时刻t2,本车辆m的位置pm与基准目标轨道kr之间的最短距离l
pmkr
为基准距离l1以上,因此异常判定部150判定为它们开始偏离了(成为了规定程度以上)。在时刻t4,本车辆m的位置pm与基准目标轨道kr之间的最短距离l
pmkr
小于基准距离l1,因此异常判定部150判定为它们吻合(小于规定程度)。在该情况下,异常判定部150在从时刻t2到时刻t4的时间为第一规定时间以上的情况下,判定为控制系统发生了异常。第一规定时间是以成为在知晓正常地动作着的控制系统中发生的“基准目标轨道与本车辆m的位置从开始偏离起到吻合为止的时间”的上限附近的值的方式,预先通过实验等求出的值。或者也可以是,异常判定部150进行规定次数的这样的时间的计测,并在基准目标轨道与本车辆m的位置从开始偏离起到吻合
为止的时间为第一规定时间以上的次数或比例为基准值以上的情况下,判定为控制系统发生了异常。
[0068]
[异常判定的放宽、停止条件、以及其他]
[0069]
异常判定部150也可以求出在基准目标轨道与本车辆m的位置从偏离起到吻合为止的期间反复生成的目标轨道k中的一部分或全部所涉及的各轨道点的、对第一风险r1的值进行统计而得到的风险程度,在风险程度为阈值th(规定程度的一例)以上的情况下,关于该对象区间不判定控制系统是否发生了异常。这是由于:所谓风险程度高,是指物体的存在给目标轨道带来的影响大,其结果是,作为正常的现象而基准目标轨道kr与实际轨迹l偏离的可能性高。反复生成的目标轨道k中的一部分或全部包括至少在基准目标轨道与本车辆m的位置开始偏离了的时间点生成的目标轨道k。
[0070]
异常判定部150也可以取得本车辆m的周边的环境信息,在环境信息满足规定条件的情况下,设置为不易判定为发生了异常。环境信息是指时间段、天气、路面状况等,规定条件是指由识别部130进行的周边识别的性能、第二控制部180对各装置的控制的精度降低这样的条件。所谓“设置为不易判定为产生了异常”,例如是指将第一阈值th1变更为更高的值、停止判定控制系统是否发生了异常。例如,规定条件是“夜间(例如20时~5时)且降雨量为oo[mm]以上的下雨天”。
[0071]
异常判定部150也可以从车速传感器取得本车辆m的速度,在速度比基准速度高的情况下,设置为不易判定为发生了异常。关于“设置为不易判定为发生了异常”这一情况的含义,与上述同样。
[0072]
异常判定部150也可以根据本车辆m的速度区域(例如,由低速、中速、高速这三等级规定)分别收集基准目标轨道和实际轨迹的数据集,并按每个速度区域来判定控制系统是否发生了异常。在该情况下,异常判定部150按每个速度区域统计“基准目标轨道与本车辆m的位置从开始偏离起到吻合为止的时间为第一规定时间以上”的次数或比例,在次数或比例为基准值以上的情况下,判定为(仅限于涉及该速度区域)控制系统发生了异常。异常判定部150可以在关于一个速度区域而控制系统发生异常时,判定为控制系统发生了异常,也可以在关于两个以上的速度区域而控制系统发生了异常时,判定为控制系统发生异常。
[0073]
根据以上说明的第一实施方式,在基准目标轨道与本车辆m的位置从开始偏离起到吻合为止的时间为第一规定时间以上的情况下,判定为控制系统发生了异常,因此即使没有明确的故障也能够发现某些不良状况、性能降低等,该基准目标轨道通过由识别部130识别到的行驶路形状确定、且是生成目标轨道的基准。即,能够早期地进行控制系统的异常判定。以往,构成车辆系统的每个部分的故障诊断的实用化不断进展,但与自动驾驶相关的控制系统整体例如硬件方面及软件方面的构成要素的组合是否正确等的验证还不充分。与此相对,在第一实施方式中,基于若本车辆m受周边的物体等的外部干扰的影响小则应该收敛这样的现象来进行异常判定,因此能够检测作为控制系统整体是否正在正确地动作。
[0074]
<第二实施方式>
[0075]
以下说明第二实施方式。第一实施方式的异常判定部150在基准目标轨道与本车辆m的位置从开始偏离起到吻合为止的时间为第一规定时间以上的情况下,判定为控制系统发生了异常,该基准目标轨道通过由识别部130识别到的行驶路形状确定、且是目标轨道生成部145生成目标轨道的基准。与此相对,第二实施方式的异常判定部150在基准目标轨
道与目标轨道之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第二规定时间以上的情况下,判定为控制系统发生了异常,该基准目标轨道通过由识别部130识别到的行驶路形状确定、且是目标轨道生成部145生成目标轨道的基准。在第二实施方式中“吻合”例如是指目标轨道中的至少从距本车辆m最近的轨道点到前方规定距离的轨道点为止的全部的轨道点与基准目标轨道的最短距离处于基准距离l2以内。基准距离l2可以是与基准距离l1同样的距离,也可以是比基准距离l1稍长的距离。
[0076]
图8是表示基准目标轨道与目标轨道偏离、且之后吻合的情形的图。在本图中,将距本车辆m最近的轨道点设为kp_1,将前方规定距离的轨道点设为kp_n。在时刻t2,各轨道点与基准目标轨道kr之间的最短距离l
kpkr
中之一为基准距离l2以上,因此异常判定部150判定为它们开始偏离了(为规定程度以上)。在时刻t4,各轨道点与基准目标轨道kr之间的最短距离l
kpkr
全部小于基准距离l2,因此异常判定部150判定为它们吻合了(小于规定程度)。在该情况下,异常判定部150在从时刻t2到时刻t4的时间为第二规定时间以上的情况下,判定为控制系统发生了异常。第二规定时间是以成为在知晓正常地动作着的控制系统中发生的“基准目标轨道与目标轨道从开始偏离起到吻合为止的时间”的上限附近的值的方式,预先通过实验等求出的值。或者也可以是,异常判定部150进行规定次数的这样的时间的计测,并在基准目标轨道与目标轨道从开始偏离起到吻合为止的时间为第二规定时间以上的次数或比例为基准值以上的情况下,判定为控制系统发生了异常。
[0077]
关于[异常判定的放宽、停止条件、以及其他],与第一实施方式同样。
[0078]
根据以上说明的第二实施方式,能够起到与第一实施方式同样的效果。
[0079]
[硬件结构]
[0080]
图9是表示实施方式的自动驾驶控制装置100的硬件结构的一例的图。如图所示,自动驾驶控制装置100成为通信控制器100

1、cpu100

2、作为工作存储器使用的ram(random access memory)100

3、保存引导程序等的rom(read only memory)100

4、闪存器、hdd(hard disk drive)等存储装置100

5、驱动装置100

6等通过内部总线或者专用通信线相互连接而成的结构。通信控制器100

1进行与自动驾驶控制装置100以外的构成要素之间的通信。在存储装置100

5中保存有供cpu100

2执行的程序100

5a。该程序通过dma(direct memory access)控制器(未图示)等向ram100

3展开,并由cpu100

2执行。由此,实现第一控制部120、第二控制部180中的一部分或全部。
[0081]
上述说明的实施方式能够如以下这样表现。
[0082]
一种移动体控制装置,其构成为具备:
[0083]
存储有程序的存储装置;以及
[0084]
硬件处理器,
[0085]
所述硬件处理器通过执行存储于所述存储装置的程序来进行如下处理:
[0086]
识别车辆的周边的物体及行驶路形状;
[0087]
基于所述识别的结果来生成目标轨道;
[0088]
使所述车辆沿所述目标轨道自主地行驶;
[0089]
在基准目标轨道与所述车辆的位置之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第一规定时间以上的情况下,判定为控制系统发生了异常,并输出判定结果,所述基准目标轨道由所述识别的行驶路形状确定,且作为生成所述目标轨道
的基准。
[0090]
上述说明的实施方式也能够如以下这样表现。
[0091]
一种移动体控制装置,其构成为具备:
[0092]
存储有程序的存储装置;以及
[0093]
硬件处理器,
[0094]
所述硬件处理器通过执行存储于所述存储装置的程序来进行如下处理:
[0095]
识别车辆的周边的物体及行驶路形状;
[0096]
基于所述识别的结果来生成目标轨道;
[0097]
使所述车辆沿所述目标轨道自主地行驶;
[0098]
在基准目标轨道与所述目标轨道之间的偏离程度从成为规定程度以上起到小于规定程度为止的时间为第二规定时间以上的情况下,判定为包括所述识别部及所述移动控制部的控制系统发生了异常,并输出判定结果,所述基准目标轨道由所述识别的行驶路形状确定,且作为生成所述目标轨道的基准。
[0099]
以上使用实施方式说明了本发明的具体实施方式,但本发明丝毫不被这样的实施方式限定,在不脱离本发明的主旨的范围内能够施加各种变形及替换。
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文章

  • 日榜
  • 周榜
  • 月榜