专利名称：自主驾驶车辆的控制和系统的制作方法
技术领域：
本发明涉及集成的传感器和基于计算机的算法系统，所述系统控制和指引自主驾驶车辆。
背景技术：
在现代汽车中，驾驶员仍然是汽车的控制系统的关键组成部分，因为驾驶员做出以车辆的安全行驶为目标的各种决策，包括速度，转向，障碍物和危险识别，及障碍物和危险的躲避。然而，由于各种物理因素，比如驾驶员疲劳，驾驶员机能障碍，驾驶员疏忽，或者诸如减小驾驶员成功避开危险所需的反应时间的能见度之类的其它因素，驾驶员完成所有这些功能的能力会受损。此外，在危险的周围环境中，例如在作战背景中，或者在存在毒害或核辐射危险的背景中，驾驶员处于危险之中。事实上，伊拉克的路边炸弹只是人员伤亡的一个现代例子， 如果向军队运送物资的补给车是无人驾驶汽车，那么在许多情况下，这样的人员伤亡是可避免的。在其它更常规的环境中，驾驶员会迷失方向或者在身体上不能控制车辆，如果驾驶员突发疾病，或者如果在驾驶情况下，驾驶员变得迷失方向，那么会发生这种情况。这种迷失方向或者丧失能力的环境的一个例子是在下雪，起雾，下雨和/或夜间灯光转暗的条件下驾驶或转向的汽车或船只，在这种条件下，驾驶员(或者船只的船长)感知正在逼近的危险，或者船只正在接近的危险，并作出反应的能力低下。从而，不论是致力于人类在车辆控制方面的不足，还是在人类控制并不可取的环境有害的条件下，都需要具有在车辆的路线中或者将进入车辆的路线中的固定物体和移动物体的车辆识别系统和方法。报告了和自动驾驶车辆及激光探测和可视化系统的开发有关的众多文献，比如下面的参考文献，所有这些文献在此引为参考1)H. Wang, J. Kearney, J. Cremer和P. Willemsen,"Steering Autonomous Driving Agents Through Intersections in Virtual Urban Environments,，，2004 International Conference on Modeling，Simulation，and Visualization Methods，(2004)；2)R. Frezza, G. Picci 和 S.Soatto，“A Lagrangian Formulation of Nonholonomic Path Following，，，The Confluence of Vision and Control，(A. S. Morse 等(编辑)，Springer Verlag，1998)；3)J. Shirazi, Java Performance Tuning，(OReilly & Associates，2000)；
4)J. Witt, C. Crane III 禾口 D.Armstrong, "Autonomous Ground Vehicle Path Tracking,，，Journal of Robotic Systems, (21 (8), 2004)；5) C. Crane III, D. Armstrong Jr. , M. Torrie 禾口 S. Gray, "Autonomous Ground Vehicle Technologies Applied to the DARPA Grand Challenge,，，International Conference on Control, Automation, and Systems, (2004)；6)Τ.Berglund, H. Jonsson 禾口 I. Soderkvist, "An Obstacle-Avoiding Minimum Variation B-spline Problem,，，International Conference on Geometric Modeling and Graphics, (July,2003)；7) D. Coombs, B. Yoshimi, T. Tsai 禾口 Ε· Kent, "Visualizing Terrain and Navigation Data, " NISTIR 6720，(March 01,2001)；8) Jenkins 等的美国专利 No. 5，644，386 ；9) Andressen 的美国专利 No. 5，870，181 ；10) Krasutsky 等的美国专利 No. 5，200, 606 ；和11) Ruff 等的美国专利 No. 6,844,924 ；尽管进行了这些工作，不过一直未实现适当的可视化，障碍识别和障碍规避系统和方法，而不存在限制车辆的操作(尤其是就市区环境中的自主指引而论)的问题。
发明内容
在本发明的一个实施例中，导航和控制系统包括配置成产生位置信号的一个或多个位置传感器，所述位置信号表示车辆的定位和航向。系统包括获得输入，并产生控制车辆的工作的输出的一个或多个操作控制机构，并且包括远离操作控制机构布置的自含式自主控制器。自主控制器包括配置成从位置传感器接收位置信号，并产生定义车辆的更新的行驶路线的操作控制信号的处理器，和提供位置传感器，操作控制机构和处理器之间的通信的可编程接口。可编程接口被配置成使从位置传感器给处理器的输入归一化，并产生用作操作控制机构的输入的兼容操作控制信号，从而自含式自主控制器是可配置的，以便与各种不同的传感器和不同的操作控制机构一起工作。在本发明的一个实施例中，车辆的导航和控制方法包括产生表示车辆的定位和航向的位置信号，借助可编程接口使位置信号归一化，从而产生归一化的位置信号，根据归一化的位置信号，产生操作控制信号，和借助可编程接口使操作控制信号归一化，从而产生归一化的操作控制信号，归一化的操作控制信号控制车辆沿着车辆的更新的行驶路线的运行。显然本发明的上述概述和下面的详细说明都是例证性的，而不是对本发明的限制。
结合附图，参考下面的详细说明，可更好地理解本发明，从而更彻底地了解本发明及其许多附带优点，附图中图IA是按照本发明的一个实施例的自主车辆的示意图，其中在与车辆的预定轴线垂直的平面的一个扇区中进行二维OD)扫描；
图IB是按照本发明的一个实施例的自主车辆的示意图，其中通过把所述扫描移出与车辆的预定轴线垂直的平面，进行三维(3D)扫描；图2是按照本发明的一个实施例的发射器和探测器系统的示意图；图3A(1)是在本发明的一个实施例中，由一个激光扫描器系统扫描的一个区域的示意图；图3AO)是在本发明的一个实施例中，由另一个激光扫描器系统扫描的互补区域的示意图；图IBB是按照本发明的一个实施例的自主车辆的示意图，所述自主车辆包括扫描系统以及光学成像系统；图4A是表示本发明的集成的自主车辆系统平台的硬件示意图；图4B是表示控制本发明的自主车辆的多个处理器的互连的功能示意图；图4C是向用户提供的，用于配置自主车辆系统平台的图形显示的屏幕截图；图5A-5C说明当穿过隧道时，在本发明的自主车辆的行驶期间，从转向控制器收集的数据，在所述隧道中，GPS信号完全消失；图6A说明按照本发明的一个实施例的变结构观测器算法应用；图6B是表示初始的速度计划和考虑到发现的障碍物后的修正路线的例证S-T 图；图6C是图解说明一个实施例的VPP计算处理的流程图；图7是表示在市区环境中，本发明的车辆的转向控制器的标准差的说明图；图8是表示即使当以30km/hr的恒定速度通过包含急转弯的回旋路程时，本发明的自主车辆使偏离规划路线的标准差保持25cm以下的说明图；图9是对来自本发明的激光扫描系统的速度值滤波的说明图；图10是说明预测自主车辆轨迹的完全非完整模型的示意图；图11是说明预测自主车辆轨迹的部分非完整模型的示意图；图12是AVS控制台示意图；图13是适合于本发明的计算机系统的示意图。
具体实施例方式现在参见附图，几附图中，相同的附图标记表示相同或者对应的部分，尤其参见图 1A，图IA描述在一个实施例中，安装在车辆10的顶部的成像传感器8，在所述车辆10中，在与车辆10的预定轴线垂直的平面11(这里为了便于举例说明，称为“垂直”扫描平面)的扇区中进行二维OD)扫描。所述成像传感器及其操作在美国专利申请序列号11/376，160 中更详细地进行了说明。该成像传感器只是可用在本发明中的成像传感器的一个例子。不过，这里的说明仍然简要概述成像传感器8的操作，以便提供本发明的应用环境。在一个实施例中，成像传感器8包括从成像传感器8向车辆10的周围环境发射激光脉冲(或光)14的发射器12 (如图2中所示)。如图IA中所示，激光(或光)脉冲14被发射到垂直扫描平面11中。为了产生三维(3D)图像，使成像传感器8摇摆(或者振荡)进出平面11，从而创建3D扫描体积16，如图IB中所示。成像传感器8通过探测从物体22反射的光，探测在车辆10附近的环境中的物体22(如图IB中所示)。
在本发明的一个实施例中，自主车辆10使用在下面更详细说明的两个激光扫描器系统40。如图2中所示，成像传感器8包括探测回波信号20的返回的探测器18。成像传感器8利用处理器M控制激光脉冲14的定时和发射，和把激光脉冲14的发射与回波信号20 的接收联系起来。处理器M可以是在车辆上，或者是成像传感器8的一部分。例证处理器的细节及其功能在后面提供。在一个示例性例子中，来自发射器12的激光脉冲14通过扩束器13a和准直仪 13b。激光脉冲14在固定反射镜1 被反射到旋转镜26，随后通过透镜27a和望远镜27b， 从而形成直径I-IOmm的激光脉冲14的射束，为合成的三维视场提供对应的分辨率。望远镜27b用于收集从物体22反射的光。在本发明的一个实施例中，探测器18被配置成仅仅探测发射光的某一波长的光， 以便区别从物体反射回探测器的激光和背景光。因此，在本发明的一个实施例中，成像传感器8通过发出激光脉冲14进行工作，激光脉冲14被物体22反射，并被探测器18测量，只要物体在探测器18的灵敏度的范围内。在激光脉冲的发射和接收之间过去的时间使处理器M可以用于计算物体22和探测器18之间的距离。在本发明的一个实施例中，光学器件 (即，13a，13b，15a，沈，27a和27b)被配置成把射束同时引导到图IA中所示的扇区中，探测器18是在与图IA中所示的相应角方向α ！对应的预定角坐标接收所接收的信号的现场可编程门阵列。借助旋转镜26，使激光脉冲14扫过平面11内的径向扇区α，如图IA中图解所示。在本发明的一个实施例中，为了实现在成像传感器8之前的视场中的物体的测绘，以 100° 10000° /秒的角速度，使旋转镜沈旋转通过30° 90°的角位移。为了产生三维(3D)图像，在本发明的一个实施例中，使成像传感器8摇摆(或振荡)进出平面11，从而创建3D扫描体积16，如图IB中所示。为了举例说明，图IB用角度 α (在垂直扫描方向上)和角度β (在水平扫描方向上)定义扫描体积16。如前所述，角度α以100° 1000° /秒的角速度，在30° 70°之间变化。角度β (即，摇摆角度) 以1° 150° /秒的摇摆速率，在1° 270°之间变化。组合的成像传感器8 —般能够以每秒不止两次的速度完全扫描3D扫描体积16。在本发明的一个实施例中，处理器M利用瞬时车辆位置的地理空间位置数据，根据物体距车辆的距离和物体相对于车辆的方向，计算视场中的物体的地理空间位置。如图2 中所示，处理器M与每秒多次向处理器M传送车辆的位置，航向，海拔高度和速度的实时定位装置25，比如全球定位系统(GPS)和/或惯性导航系统(INS)通信。实时定位装置25 一般安装到车辆10上，把数据(比如车辆的位置，航向，海拔高度和速度)传给车辆10上的所有成像传感器8 (和所有的处理器24)。借助可从市场获得的GPS和INS单元，处理器M能够以高于IOcm的精度，确定视场中的物体的位置。在本发明的一个实施例中，处理器M把GPS位置，LADAR测量结果和偏转角数据联系起来，以产生在车辆的路线中的障碍物的地图。地图的精度取决于来自定位装置25的数据的精度。下面是这种数据的精度的典型例子位置10cm，前向速度0. 07km/ hr，加速度0.01%，滚转/俯仰0.03°，航向0.1°，横向速度0.2%。在本发明的一个实施例中，Kalman滤波器(产业化的)分类给处理器M的所有数据输入。Kalman滤波器是一种根据噪声数据的递归测量，估计系统的状态的已知方法。在这种情况下，通过考虑到在每种传感器中固有的噪声的种类，随后构成实际位置的最佳估计， Kalman滤波器能够更加精确地估计车辆位置。A. Kelly在“A 3d State Space Formulation Of a Navigation Kalman Filter for Autonomous Vehicles,，，(CMU Robotics Institute, Tech. Rep. , 1994)中说明了这种滤波，该文献的整个内容在此引为参考。可从市场获得的组件可被用于发射器12和探测器18，以提供距离测定结果。在一个实施例中，发射器12，探测器18和相关的光学器件构成激光雷达(LADAR)系统，不过在本发明中可以使用能够精确测量距离的其它系统，比如激光探测和测距(LIDAR)传感器，雷达，或照相机。LIDAR(激光探测和测距；或者激光成像探测和测距)是一种利用激光脉冲确定到物体或表面的距离的技术。图3A(1)是在本发明的一个实施例中，由一个激光扫描器系统扫描的一个区域的示意图。图3A(2)是在本发明的一个实施例中，由另一个激光扫描器系统扫描的互补区域的示意图。结合旋转镜，每个激光扫描器系统40利用四个激光器发射激光脉冲14，以便扫过在传感器前面的例如270°弧形区域。本发明并不局限于正好扫过270°弧形区域，可以使用从180°到270°到360°变动的其它弧形区域。在这个例子中，射束从在4个不同的扫描平面上的单元发出，当使反射镜直接指向前方时，所述4个不同的扫描平面偏移0. 8°， 当使反射镜直接指向侧面时，所述4个不同的扫描平面偏移0°。通过这样利用多个激光器，即使当在机动过程中，车辆俯仰和滚转时，扫描系统40也能够保持足够的视场。扫描器系统40可被安装在离地高度不同的位置。例如，通过把传感器安装在0. 5 米的较低高度，传感器能够和如果把传感器安装在车辆上更高的位置相比，更有效地探测较小的障碍物。另一方面，当安装位置较低时，某些水平安装的传感器不会同样有效，因为当车辆发生俯仰时，所述传感器的扫描平面常常被地面阻断。按照惯例，需要360°整周扫描器覆盖的车辆使用在车辆前部的一个扫描器系统， 和在车辆后部的一个独立扫描器。这种使用两个ECU (—个用于前部传感器，一个用于后部传感器)的方案使系统易受单点故障影响。本发明通过利用都具有完整的360°视场，从而提供周围环境的冗余视图的两个扫描器，解决单点故障的问题。每个扫描器系统具有在车辆的前部角落之一的一个传感器，和在车辆的相反后部角落的一个传感器，如图3A(1)和 3A(2)中所示，以及它自己的ECU。事实上，图:3B是按照本发明的一个实施例的自主车辆的示意图，它包括扫描系统(比如两个激光扫描器系统40)以及光学成像系统42。对在市区环境中行驶的自主车辆来说，存在几个重大的技术挑战。通过本发明的创新的硬件和软件设计，解决了这些挑战。1)由于存在于市区环境中的建筑物和其它障碍物，常常不能获得GPS数据。由于自主车辆的任务的许多要素是借助GPS坐标指定的，因此在本发明中，可以利用辅助的定位信息来补充GPS数据。2)除了静止的障碍物之外，在市区环境中还存在许多移动车辆。在本发明的一个实施例中，车辆的软件跟踪、与其他车辆的交互和不时预测其它车辆的移动。幻自主车辆必须始终遵守所有适用的交通法规。4)在市区环境中的自主车辆不时完成高级机动，比如超车，泊车，进行调头，穿过迎面而来的车辆的车道左转弯，和在交通拥挤的情况下驾驶车辆。5)在市区环境的某些区域中，将仅仅用稀疏的一组路点指定道路，本发明的自主车辆将利用传感器探测沿其而行的适当路线。在本发明中，用跟踪自主车辆和环境中(尤其是在十字路口)的其它车辆的状态的软件系统，解决了这些挑战。系统组件工作车辆改进2005 Ford Escape Hybrid (下面称为工作车辆)，以包括本发明的成像传感器8。工作车辆使用混合驱动系统，在混合驱动系统中，电机实质上始终在运转， 燃气发动机自动启动和停止，以或者提供额外的马力，或者对电机的电池再充电。由330伏电池供电的工作车辆的电气系统向安装在工作车辆中的设备提供1300瓦以上的功率。工作车辆利用可从市场获得的Electronic Mobility Controls(EMC)的高级电子汽车接口技术(AEVIT) “线控”系统物理控制汽车。AEVIT系统利用冗余的伺服系统和电动机转动方向盘，换档，控制油门和踏下制动器。这种可在市场上从EMC公司获得的解决方案包括安装在转向柱，制动踏板，油门拉线，紧急制动器和自动变速器上的致动器和伺服系统。它还能够控制车辆的转向信号和点火。通过利用电子驾驶辅助控制系统，利用一个充分集成的系统控制车辆的所有各个方面，从而降低整体复杂性，和消除单点故障。电子驾驶辅助控制系统还向自主车辆提供紧急停止(E-Stop)机构，当被触发时，紧急停止机构应用车辆的主制动系统，随后关闭车辆的点火。最后，在稍微延迟之后，应用和保持车辆的紧急制动。这确保当收到Eltop命令时，车辆能够有效地停止，并且即使车辆在斜坡上，也能够保持停止状态。在本发明中，这些能力被认为是可选的。硬件平台为各种自动驾驶应用设计了本发明的自主车辆系统(AVS)平台。AVS 平台包括硬件层和软件层。硬件层包括印刷电路板或其它自含式配线和器件结构，所述印刷电路板或其它自含式配线和器件结构包含向外部传感器，比如GPS接收机或障碍物传感器，以及操作控制机构供电，并与所述外部传感器及操作控制机构通信的配线，所述操作控制机构获得输入，并且产生控制车辆的运转的输出。在一个实施例中，专用集成电路(ASIC) 可用于此用途。图4A是表示本发明的集成的自主车辆系统平台的硬件示意图。图4A具体表示包括用户或程序接口 52，计算机53，54,现场可编程门阵列器件56，安全无线电设备58，硬件监视器60，以太网链路装置62，配电组件64，紧急停止(E-Stop)逻辑器件66，内部和外部控制器局域网(CAN) 68，数字和模拟输入/输出装置70，及RS-232和RS-422端口 80的AVS 印刷电路板50。通过把这些组件集成到印刷电路板上，自主车辆系统(AVQ平台提供使各种传感器与计算能力结合的硬件，以处理传感器数据和指挥自主车辆。此外，通过在印刷电路板上实现大部分的物理配线，而不是用手实现配线，本发明的AVS平台中的硬件层的可靠性提高。此外，在本发明之前，为特定的传感器及驾驶和转向控制装置特别设计或改进自主车辆。这些样车大部分用于解决自主车辆的开发过程中的特定问题，因为本行业常常围绕自主车辆工程师知道的已知问题的特定解决方案的目标开发这些车辆。因此，当时不存在产生更通用的自主车辆控制平台的现实推动力。此外，要结合哪些种类的传感器和哪些种类的驾驶控制系统的未决问题使可能要与感测和控制自主车辆的无数种选择匹配的系统的设计处于提出的技术太不成熟，以致不能考虑这种通用解决方案的状态。因此，在本发明的一个实施例中，提供用户或程序接口 52，借助用户或程序接口 52，用户能够对用于特定传感器和特定的驾驶转向控制装置的可配置接口装置编程。例如， 在自主车辆中安装AVS印刷电路板50的工程师将对用于自主车辆上的特定的一组传感器的现场可编程门阵列器件56( S卩，可配置的接口装置)和用于特定的驾驶和转向控制装置， 比如AEVIT线控系统所需的控制装置的程序(S卩，操作控制机构)编程。在另一个例子中， 现场或服务技术人员可在自主车辆上安装新的传感器，并在当时对现场可编程门阵列器件 56重新编程，以便与新安装的传感器兼容。在一个实施例中，印刷电路板50与安全无线电设备58的E-Mop无线电设备接口，并与AEVIT线控系统(构成图4A中描述的计算机之一)接口。在一个实施例中，硬件层包括监控硬件的操作，并且能够循环启动故障组件(例如，通过配电组件64)，或者如果探测到致命的错误，那么甚至能够停止车辆(例如，通过E-Mop逻辑器件60)的可编程逻辑器件(即，硬件监视器60)。在一个实施例中，对计算机53，M来说，AVS硬件层包括运行 QNX硬实时操作系统的htel Core Duo计算机。这些计算机被用于运行AVS软件平台。系统内通信图4B是表示控制器局域网络(CAN)和AVS软件/硬件与传感器之间的处理关系的功能示意图。根据所包含消息的关键性和准时，可以分割在AVS平台的各个组件内的通信。在一个实施例中，可通过独立的控制器局域网络(CAN)传送AVS软件和线控系统之间的车辆控制消息。在一个实施例中，CAN 68具有集成的优先权系统，该系统提供可预测的实时通信(例如，驾驶和控制信号)，并提供抗电磁干扰的鲁棒性。在本发明的一个优先权控制系统中，紧急控制，以及车辆的停止(如果需要的话)获得最高的优先权， 并且取代CAN总线上的任何通信。除了紧急消息的不常存在之外，规划软件和线控系统之间的控制通信能够作为第二优先权，不受限制地出现预定的时间量。 在一个实施例中，在印刷电路板50上，独立的CAN总线被用于与专门为自动应用而设计的传感器的通信(例如，传感器信号)，该CAN总线可以或不可用于其它形式的通信。 通过使控制网络专用于传感器，防止控制分组取代输入的传感器分组。另外，这种分离有助于防止传感器网络上的故障装置破坏控制CAN总线，因为这种破坏会危及自主车辆的安全运行。在一个实施例中，在印刷电路板50上，通过以太网链路装置62发生传感器和规划计算机53，54之间的高带宽通信。与AVS平台耦接的高精度传感器能够产生非常适合于以太网链路装置62提供的高带宽，低等待时间和容错性的大量数据。在一个实施例中，来自定位传感器的位置数据和来自障碍物扫描器的物体数据都包含时间戳，所述时间戳消除了对定位传感器和障碍物扫描器的数据的确定性传输的需要。在行程规划计算机53，54内能够重构和重新排序位置数据和障碍物数据，以重建传感器任意之一的世界视场。在一个实施例中，在印刷电路板50上，现场可编程门阵列器件56收集位置和移动信息，在数据被传给计算机53，M之前，能够补偿惯性系统中的漂移和GPS系统中的中断期。校正后的数据随后经以太网和CAN被发给计算机53，54。校正后的数据还经专用 CAN总线被传给障碍物扫描器。该数据被发给障碍物扫描器，以致汽车的位置，速度和定向可被用于潜在帮助校正扫描器的障碍物数据。计算机53，54随后能够使障碍物，自动机的位置和任务路点与相同的坐标集联系起来。现场可编程门阵列器件56能够提供位置传感器、操作控制机构和处理器之间的通信，并且能够1)使从位置传感器或物体传感器到处理器的输入归一化，和2)产生作为给操作控制机构(比如上面讨论的高级电子汽车接口技术 (AEVIT))的输入应用的兼容操作控制信号。这样，印刷电路板50(8卩，自含式自主控制器) 是可配置的，以便与各种不同的传感器和不同的操作控制机构一起工作。
因此，通过新颖的配置，集成印刷电路平台实施例为本发明的自主车辆提供独特的能力，所述新颖的结构包括配置成从自主车辆的车载传感器接收输入，识别从一个目的地到另一个目的地的行进路线，识别沿着所述行进路线的固定障碍物和移动障碍物以及路点，和修正行进路线，以避免固定障碍物和移动障碍物的处理器。集成印刷电路平台包括在功能上的中央位置的可编程装置，所述可编程装置提供接受来自自主车辆传感器的输入， 和给驾驶和转向控制装置的输出，并使所述输入和输出归一化的能力。从而，所述平台通过 1)在印刷电路板上包括各种输入/输出装置，和2、提供用户能够借助其，为特定的一组传感器和转向控制装置“定制”平台的接口，提供适应各种各样的自主车辆传感器的能力。如上所述，用户或程序接口 52向用户提供一种机构，借助该机构，FPGA 56能够被编程，以适应包括在自主车辆上的各种传感器及驾驶和转向控制装置。图4C是当用户访问所述用户接口时，提供给用户的图形显示70的屏幕截图。图形显示70包括允许用户选择输入栏，例如电压(V)，车辆CAN反馈，EMC CAN反馈，和比例增益控制的控件。如图4B中所示，用户或程序接口 52允许通过与计算机53和/或M交互，或者通过与现场可编程门阵列器件56直接交互，配置自主车辆系统平台。传感器自主车辆需要周围环境和它自己的全球位置的精确图像，以便在任何环境中安全导航。对于在市区环境中行驶来说，存在额外的挑战。下面说明在本发明的各个实施例中，安装在本发明的自主车辆上的不同种类的传感器。定位或位置传感器对进入市区环境的自主车辆或自动机的挑战之一在于建立在自动机周围的世界的地图，和查找它自己在地图中的位置。从障碍物和车道探测传感器收集的数据以世界中的某一绝对位置或者相对于车辆的某一位置为参考。在没有关于车辆的位置，航向和速度的绝对信息的情况下，其它数据会变得无用。通过把关于车辆收集的所有信息转换成一组全球坐标，简化了在世界内并且与交通量结合的路线规划。进行这种转换需要精确地了解在收集数据时车辆的位置。根据该信息，能够创建在自主车辆周围的区域的地图，根据所述地图，能够规划自主车辆的路线。根本上，规划自主车辆的路线和合成从传感器收集的数据需要精确的定位信息。 上面说明的工作车辆利用Oxford Technical Solutions的RT3000 定位装置提供车辆定位(即，定位数据)。RT3000 利用Omnistar HP差分GPS信号提供10厘米或以下的位置精度，并提供精确到0. Γ以内的航向测量结果。RT3000 中的集成惯性导航系统(INS)允许RT3000 经受得住高达30秒的GPS中断期，而无实质性的性能降低。INS提供加速度和滚转信息。除了惯性系统内的加速度计和陀螺仪之外，经防抱死制动系统(ABQ接口板，从 Ford Escape Hybrid后部ABS轮速传感器之一输入的轮速被提供给RT3000传感器。AVS 接口板读取从FordEscape的ABS传感器到R)rd Escape的ECU的通信信号，并将其转换成 GPS能够利用的信号。RT3000传感器利用内部提供给RT300传感器的Kalman滤波和算法的组合，内部集成来自每个来源的数据。在本发明中，RT3000传感器被用作有效的定位传感器的一个例子。即使在GPS信号部分或完全失去的情况下，RT3000传感器也能够适当补偿失去的信号。图5A-5C表示在自主车辆穿过隧道期间，从转向控制器收集的数据，在所述隧道中，持续10-15秒完全失去 GPS信号。当重新获得GPS信号时，车辆仅仅偏离理想路线50厘米的事实证明RT3000传感器的可靠性，并且证明控制系统与源于RT300传感器的数据一起有效工作的能力。在这些图中，Y-Error是给控制系统算法的输入信号，路线误差是车辆中心线偏离理想路线的实际量，转向角是车辆的前轮的角度。当Y-Error信号增大时，转向角将被调整，以力图使实际的路线误差降至最小。障碍物或物体传感器在上面概括讨论的一个实施例中，本发明的自主车辆使用两个 Ibeo ALASCA XT 融合系统传感器(Ibeo Automobile Sensor GmbH, Merkurring 20， 22143 Hamburg, Deutschland)作为其主要的障碍规避传感器。每个ALASCA XT融合系统传感器包括两个rteo ALASCA XT激光扫描器和一个^eo电子控制单元(EOT)。工作车辆中的每个ALASCA XT激光扫描器利用四个eye-safe激光器和旋转镜一起扫描在传感器前方的270°弧形区域。ALASCA XT激光扫描器中的所有四个射束从在4个不同的扫描平面上的单元发出，当使反射镜直接指向前方时，所述4个不同的扫描平面偏移0. 8°，当使反射镜直接指向侧面时，所述4个不同的扫描平面偏移0°。由于其视场的灵活性，这个实证中的ALASCA XT激光扫描器被固定安装在车辆上， 离地高度约0.5米。其它高度位置也适合于本发明。通过把传感器安装在0.5米的较低高度，与把传感器安装在车辆上更高的地方相比，传感器能够更有效地探测较小的障碍物。当安装位置较低时，某些水平安装的传感器不会同样有效，因为当车辆发生俯仰时，所述传感器的扫描平面常常被地面阻断。由于其探测单一激光束的多个回波的能力，因此ALASCA XT激光扫描器能够在各种气候条件下工作。如果射束到达透射物体，比如玻璃窗格或者雨滴，那么它将产生部分回波，所述部分回波同样被激光扫描器识别和鉴定。这种多目标能力使ALASCA XT激光扫描器能够在许多不同类型的恶劣天气，包括暴风雨中工作。ALASCA XT激光扫描器的另一个优点是电子控制单元(ECU)的结合来自两个 ALASCA XT传感器的激光角度和测距信息，从而创建车辆周围的物体的地图的能力。在滤波除去无关的激光回波，比如雨滴和地面的激光回波之后，ALASCA XT激光扫描器控制系统结合来自两个激光扫描器的数据，随后根据多组回波拟合多边形。之后，ECU中的软件算法计算每个障碍物的速度向量，并用它自己的标识号识别每个障碍物。为了降低计算开销，ECU 只传送满足特定的优先权分类算法的障碍物。在本发明的一个实施例中，自主车辆利用以物体速度和距车辆的距离为基础的算法，作为所述分类的主要标准。经CAN把得到的多边形传给计算机53，54。在这个实施例中，由于该处理都是在ALASCA XT激光扫描器的ECU本地完成的，因此使计算机53，M免除该额外的处理开销。从两个障碍物探测系统40返回的障碍物的集合被合并到车辆的障碍物储存库中。在一个扫描器系统未能返回障碍物的列表的情况下，车辆无缝地利用另一个扫描器系统继续操作，而不失去它的任意视场。当探测到一个扫描器系统的故障时，AVS平台的硬件层能够重新启动系统，以查看当重新启动时是否出现恢复。在本发明的另一个实施例中，Velodyne LIDAR(例如HDL-64E型号，一种提供 360° HFOV*^. 8° VFOV的64-element LIDAR传感器)被用作障碍物探测器40。该LIDAR 系统以5-15HZ的帧速率和每秒130万以上的数据点为特征。它产生的点云数据产生地形和环境信息。距离和强度数据都在以太网输出分组有效负载中提供。HDL-64E甚至能够仅仅依赖于关于环境的信息，于是向上面说明的其它传感器提供冗余。HDL-64E传感器利用 64个激光器提供0. 09°角分辨率(方位角)的360°视场(方位角)，具有64个间隔相同的角度细分(约0. 4° )的26. 8°垂直视场(高程)(+2° ,-24. 8° )。HDL-64E的精度小于2cm。HDL-64E以5-15Hz (用户可选)的速率更新视场，对人行道为说具有50米的距离 ( 0. 10反射率)，对汽车和树叶来说具有120米的距离( 0. 80反射率)。车道/道路探测传感器有时候，在只有稀疏的一组路点识别车道/道路的情况下，自主车辆必须找出并跟随适当的车道/道路。为了解决这个问题，在本发明的自主车辆的一个实施例中，基于视频的车道探测系统，例如Iteris，Inc. (Iteris，Inc.，Santa Ana, California)的LDW型号被用作成像装置42。Iteris LDW系统利用光学传感器和图像处理系统探测和跟踪车道标记。LDW系统中的成像传感器创建在车辆前方的LDW系统搜寻车道标记的区域的二维数字化图像。在工作车辆中，成像传感器安装在挡风玻璃的顶部，不过向前的其它位置也是适宜的。基于视频的车道探测系统向自主车辆提供左右车道标记的位置，左右车道标记的类型(实线，虚线等)，车辆在车道内的角度，和车道的曲率。经CAN 68b 以每秒25次的速率把该信息提供给AVS平台软件。来自基于视频的车道探测系统的信息被用于建立当前车道的模型，当前车道的模型能够被车辆的软件系统用于调整车辆的规划路线，以更好地遵守车道模型。软件平台自主车辆为在市区环境中成功行驶而需要的软件的体量和复杂性会容易地倾覆软件体系结构。AVS软件平台被设计成能够用于许多不同种类的自主车辆应用程序的通用自主应用架构。AVS软件平台提供传感器集成功能，障碍规避功能，导航功能，安全系统，事件记录系统，定位功能，实时车辆监控功能，和网络集成功能(以及许多其它基本的自主车辆需求)。工作车辆中的AVS软件平台使用Java编程语言，不过本发明并不局限于这种编程语言。由于Java的平台独立性，相同的代码库能够结果可靠并且可重复地在各种平台上运行。如下所述的AVS软件架构使用几种不同的软件设计模式或设计原理来降低设计自主车辆应用程序的复杂性。这些设计模式都已被证明在企业应用程序开发中，能够成功地降低复杂性，和提高软件开发的可靠性。在本发明的AVS软件架构中使用的主要软件设计原则之一是“关注点分离”范例， 它通过把较大的问题分成被设计成更易于解决的一组松散联系的子问题，降低开发的复杂性。因此，软件系统被分成重叠量最少的尽可能多的不同组件。通过把软件分成功能上分离的组件，一个组件中的微小故障不会不利地影响其它组件。利用以控制反转(IoC)容器为中心的体系结构，实现了 AVS软件架构。控制反转是其中所述架构起协调和控制各个应用程序组件的运行的容器的设计模式。IoC架构简化了应用程序设计，因为所述架构，而不是应用程序把组件链接在一起，并负责把事件路由给应用程序中的恰当组件。在AVS架构中，IoC容器提供正确的实时自主车辆应用程序所必需的所有服务，包括线程调度，记录服务，跨计算群集的应用程序资源的分布，容错和网络通信。AVS软件架构的线程调度能力显著增强了自主车辆应用程序的开发。为了使关注点分离范例最有效，应尽可能地隔离组件。理想地，组件应并行运行，而不是顺序运行，以致一个组件中的故障不会导致后续组件的运行被异常中止。AVS软件架构甚至跨越多个计算机，随同它自己的线程执行，执行每个组件，并透明地协调数据在分离组件之间的共享。AVS 软件架构还能够在许多不同的处理器负载水平下，以设定的频率执行这些组件，对自主车辆操作所需的许多控制系统来说，这是有益的，因为为了实现精确的车辆控制，这些控制系统都需要精确的定时。一个实施例中的AVS软件架构能够在一个或多个核心嵌入式计算机(而不仅仅是图4A中所示的两个计算机53，54)上运行。事实上，三个核心嵌入式计算机已起分布式群集的作用。群集中的每个计算机运行与AVS软件架构的实时能力耦接的硬实时操作系统， 以支持在预先规定的时间约束内，自主应用程序的确定性执行。一旦允许实时支持，进程的工作频率彻底稳定。AVS软件架构的实时能力还使自主应用程序可以表现得更加始终如一，并且即使在软件出现问题的情况下，也保证允许优先权较高的组件，例如安全监视器和低级驾驶算法正确地执行。软件实现软件逻辑被实现成AVS软件架构的模块。AVS软件架构能够随同它自己的独立的线程执行，运行这些模块中的每个模块，并且它自动管理多个组件之间的相关性。 下面的小节说明在本发明中利用的软件模块。路线规划环境的绘图和长距离路线规划是自主车辆的设计中的重要考虑因素。 利用的设计模型把直观的绘图和逻辑绘图和路线规划分开。车载计算机进行的逻辑绘图功能包括十字路口组件的识别，传感器看得见的标记的绘图，和地图定义不明确的地区的校正。地图定义不明确的地区由提供给自动机(即，自主车辆)的地图与真实世界的环境不是充分关联的区域组成。这种情况下，自动机必须沿着其行进路线探索和识别该地区。在本发明的一个实施例中，把预先存在的地图转换成坐标数据被证明是一种与诸如勘测之类的其它方法相比，更有效地获得转向方向的方式。在一些情况下，不能获得预先存在的地图。如果自主车辆被设计成在“封闭”的路线(即，由物理边界或软件引导的边界设定的路线)内行驶，那么车辆的人工控制可被用于控制通常自主的车辆，而自主车辆绘出封闭路线的地图。通过关联来自其GPS，障碍物扫描器和车道探测传感器的信息，自主车辆能够绘出指定路线的地图。—旦获得表示所述路线和沿着该路线的路点的逻辑地图，就按照例如路线网络定义文件(RNDF)格式，把逻辑地图提供给车载计算机53，54，不过也可以使用其它格式。两遍剖析器(two-pass parser)识别所有路点，之后核实所有路点参考是否有效。地图是按照面向对象修改的RNDF格式保存的，并且包括关于从RNDF文件得到的地图特征的扩展。从RNDF中的数据中获得的第一个导出特征是停车点和出口 /入口路点到十字路口的分组。下面是例证的绘图/路点算法。算法首先挑选停车路点，随后找出离开该路点的所有出口和进入该路点的所有入口。随后，对十字路口中的每个出口来说，如果该出口之后的路点是入口，那么把该入口 /出口对增加到该十字路口中。同样地，对十字路口中的每个入口来说，如果在该入口之前的路点是出口路点，那么把该出口 /入口对增加到十字路口中。最后，如果任何停车点或出口在与十字路口的边界相隔规定距离的范围内，那么也把它们增加到十字路口中。做出规定，以确保每个停车点或出口只属于一个十字路口。从RNDF中的数据获得的第二个导出特征是与在路点之间的行驶相关的成本的存储。从一个路点行驶到下一个路点所用的时间是用于挑选最佳路线的主要候选度量。时间度量被保存在路点、出口和区域对象中。最好通过把路段最大限速除以每个路点和其前一个路点之间的距离，计算该路点的初始成本。如果路点在车道的起点，那么它具有零成本。 根据入口路段的速度加上固定的处罚(penalty)，计算出口的成本。
本发明的一种路线寻找算法可包括随着自动机更多地探索其周围环境，使自动机 (即，自主车辆)在其规划方面变得更高效的学习组件。通过记录在路点之间、穿过十字路口和通过区域所用的行驶时间，能够计算使行驶时间最优的路线。为跨多条路线使用的给定RNDF保持行驶时间的记录。当交通模式随着时间变化时，标记新的拥堵区域，不再信任旧的观察结果。利用如等式1中所示的权重几何递减的加权平均公式计算特定行驶单元的成本。最新的观察结果具有0.5的权重，每个先前的观察结果的权重减半。样本N=样本数N = 1 :sum S0N>l:sum = S0*l/(21) +S1 * 1/(22) +· . . +SN_2 * 1/(2^1) +Sm * 1 (2N) (1)在本发明的一个实施例中，通过应用称为Α*试探引导搜索的搜索算法，确定检查点之间的最佳路线。类似地可以使用其它算法。Al叟索算法保持已探索路线的优先权队列。优先权由路线的当前成本(g(x))和到终点的估计成本(h(x))确定。在用于路线规划的A*的实现中，g(x)是已探索过的行驶单元的平均观察行驶时间之和。试探值h(x)是到目标检查点的直线距离除以路线的最大限速之商。该试探值影响首先探索最直接的路线的行为。A*算法已被证明在模拟测试和实际测试中都产生精确的路线。可变结构观测器(VSO) :VS0的主要功能是提供在自主车辆的附沂环境(大约在 150米内)的所有固定障碍物和运动障碍物的坐标和轨迹的信息集成和预测。可变结构观测器算法跟踪多个固定物体和运动物体。可变结构观测器算法改进车辆的环境观察，提供即使传感器数据或者暂时失去，或者变得暂时不可靠，也保持车辆的智能行驶和导航的能力。在一个障碍物暂时被另一个障碍物遮蔽的情况下，例如当另一辆车正在驶过在自主车辆之前的十字路口时，这是极其有用的。图6A说明按照本发明的一个实施例的VSO算法应用。具体地说，图6B是在自主车辆的规划路线(即，标注PP的曲线)与描述成一系列较小的运动矩形82的雷达跟踪车辆(运动障碍物)的路线相交的情况下，提出的可变结构观测器的示范。在这个例子中，雷达波束(即，从左下角延伸的角度移动线)被两辆拖车84(即，较大的矩形)阻挡。当由于被拖车84阻挡，跟踪的运动障碍物82从雷达屏幕上消失时，可变结构观测器通过运行其模型，从而产生该运动车辆的预测位置，把运动障碍物82保持在存储器中。沿着自主车辆路线的速度规划把该运动障碍物与所述路线相交时的时间考虑进去。虚线圆形区域中的重叠矩形表示由不确定性引起的预测位置的误差。从而，即使当数据流中断时，可变结构观测器也能防止碰撞。提出的可变结构观测器允许跟踪数目不受限制的运动障碍物，仅仅取决于系统的计算能力。VSOJICai^i (Drakunov,S. V. ,"Sliding-Mode Observers Based on Equivalent Control Method, " Proceedings of the 31st IEEE Conference on Decision and Control (CDC), Tucson, Arizona, December 16-18，1992，pp. 2368-2370)中提出的滑模观测器的思想为基础，该文献的整个内容在此引为参考，并以可变结构系统的一般理论为基础。 其原理可被描述成如下所示一旦传感器系统探测到障碍物，就使用初步数据处理识别障碍物的位置，几何形状和速度向量。VSO算法将自动创建障碍物的“标识符”，及障碍物的数学运动模型。
结果，产生识别的障碍物的状态向量[位置，几何形状，形状，速度等等]。根据输入的传感器数据流，持续更新该状态向量(即，其参数)。如果暂时失去传感器数据，那么 VSO算法将继续提供(通过模拟)障碍物的位置和速度的预测，以使暂时致盲的车辆安全地停车，或者避免障碍物，直到重新获得传感器数据为止。通过前移至未来时间运行VSO算法，VSO不仅能够预测障碍物的当前位置，而且能够预测障碍物的未来位置，以便进行路线规划和速度规划。遵循某些规则。例如，如果识别的物体是沿着与自主车辆相同的道路行驶的移动物体，那么VSO将认为识别的物体停留在道路上。例如，如果识别的物体是一直沿着与自主车辆相同的道路行驶，并且一直以几乎恒定的速度行驶的运动物体，那么VSO将认为识别的物体停留在道路上，并且继续以相同的速度(除非其它物体干预)行进。VSO把在附近环境中的所有障碍物的状态向量结合成车辆的行驶环境的一个可变结构模型，该模型随着环境动态变化。由于VSO将增加进入该区域的障碍物的新模型，和除去离开该区域的障碍物，因此观测器状态向量的维数不断改变。在本发明的一个实施例中，可变结构观测器以关于滑模的系统的理论为基础。从非线性数学了解滑模的应用，在其它“系统中”，滑模一直用于分析系统的时间行为。在本发明的可变结构观测器中，滑模被用于在存在不确定性的情况下，根据强非线性系统的观测数据，重构状态向量。下面更详细地说明在路线规划的情况下的VSO的应用。在实际的实践中，VSO带来另一个好处。通过在其计算中包括车辆运动的数学模型，VSO自动滤出会在传感器数据中出现的波动。就激光扫描器传感器来说，这尤其重要， 因为速度向量(这些传感器计算的速度向量)会包含相当大的抖动。路线规划本发明的路线规划算法规避障碍物，并在规划的通道内常规地驾驶车辆。在一个实施例中，这些算法不会毫无原因地使车辆偏离规划的通道。不过，如果车辆由于某种原因离开路线通道，那么导航系统会探测到这种情况，并提供回到所述通道的安全路线。如果错过某一路点，那么导航系统将只是延续到路线上的下一个可行的路点。如果路线被障碍物阻断，那么路线规划系统将确定障碍物周围的路线。在本发明的一个实施例中，路线规划是通过利用三次b样条实现的，三次b样条被设计成跟随规划路线的中心，同时仍确保对车辆来说，路线不是不能导航的。这种保证意味沿着路线的任意点的曲率小于车辆能够成功跟随的最大曲率。另外，使曲率保持连续，以致不必停下车辆，以便在继续行驶之前，把方向盘转动到新的位置。在路线规划算法中选择使用B样条主要是因为能够容易地控制其结果曲线的形状。在创建跟随通道的中心的初始路线之后，对照障碍物储存库检查该路线，以确定它是否是安全的路线。如果该路线不安全， 那么简单的算法产生并调整在曲线的问题地点的控制点，直到样条避开所有已知的障碍物，同时仍然包含有效的最大曲率为止。此时，该路线即安全，又是可行驶的。本发明的路线规划还可利用基于细节水平(LOD)的障碍规避算法，以及几种规划算法来规划障碍物周围的路线。在本发明的一个实施例中，LOD分析允许以不同的细节水平，运行相同的算法。例如，如果在不太细致的情况下运行算法(例如，以适应较大的安全余量)，那么反复增大细致度(例如，以适当较小的安全余量)，直到找到有效路线为止。路线规划算法利用几个不同的参数运行，直到找到有效路线为止。初始参数利用安全余量 (例如，车辆距离障碍物，或者在障碍物之间的间隙)，而最终参数不使用障碍物周围的安全余量。这确保如果能够获得将以较大的误差余量(例如，车辆横向间隙)避开障碍物的路线，那么路线规划软件选择该路线。否则，规划算法将持续减小障碍物周围的安全余量， 直到确定有效路径为止。本发明适应诸如汽车牵引力和对车辆的外力之类的因素。系统识别是本发明使用的一种方法，借助该方法，能够通过使输入系统中的信号与系统的响应关联，确定定义系统的参数，从而形成按照和实际的车辆系统相同的方式(或者相似的方式)表现的传递函数。 例如，当试图控制车辆的速度时，输入是制动器和加速器位置，输出是车辆的速度。可用传递函数H(S)描述系统模型，y (s) = H(s)u(s)，(8)其中是U(S)系统输入(制动器和加速器位置)，y(s)是系统输出(速度)。对来自车辆推进系统的真实世界数据应用系统识别，以得出对于工作车辆，根据经验测试的车辆系统的传递函数H(S)，直到相信获得精确的传递函数为止。因此，按照本发明，车辆的速度控制不仅适应加速器和制动器功能，而且适应物理引擎系统中的许多其它因素。例如，由于工作车辆具有燃气-电混合动力引擎，因此，两个推进系统的联结由考虑到燃油效率而调整的在工厂安装的难以接近的车载计算机控制。从而，请求的踏板位置和达到的实际位置之间的映射不是线性的，必须依据经验确定，用软件重新映射。在本发明的一个实施例中，车辆的速度由集成的比例微分(PD)控制器控制。该控制器使其输出以先前的输出为基础，并以当前误差和误差的导数为基础。在时域中，控制器可被写为u(t2) = (t2-tl) (Kpe (t2)+Kde ‘ (t2))+u(t1)(9)其中K1^PKd是可调系数，u(t)是在时间t，控制器的输出，e(t)是在时间t的误差。误差被定义成从目标输出减去的实际输出。实际输出由RT3000报告，从路线规划算法得到目标速度。对照上面详细说明的导出的传递函数，设计和调整集成PD控制器。例如，首先对照导出的传递函数的计算模型，导出最佳性能所需的权重(用于PD控制器中的比例控制)， 随后当作用于该车辆时调整所述权重。利用均与路线规划系统无关的两个独立过程，在工作车辆中实现加速器和方向盘控制。一旦路线规划算法决定了路线，就仅仅使用加速和转向，以保持选择的路线。由于在创建时，检查了路线的可行性，因此控制系统认为对车辆来说，给出的所有路线都是可实现的。按照这种方式(不过本发明可以使用其它启始假设)，决定如何最佳地继续下去，以便沿着选择的路线而行就成为控制系统的负担。在一个实施例中，工作车辆的转向控制器是以Riekert和khunck的“Zur fahrmechanik des gummibereiften kraftfahrzeugs, “ ( ^t Ingenieur Archiv, vol.11, 1940，pp. 210-2 中)描述的典型单行道模型或者自行车模型为基础的超前-滞后控制器，该文献的整个内容在此引为参考。超前补偿器提高系统的响应性；滞后补偿器降低 (但不消除)稳态误差。超前-滞后补偿器以系统的频率响应为基础。超前-滞后补偿器与 D. Bernstein 在 A students guide to classical control, IEEE Control Systems Magazine, vol. 17，pp. 96-100 (1997)中说明的类似，该文献的整个内容在此引为参考。最后得到的工作车辆中的控制器是乘以低频率增益的两个超前和滞后函数的卷积，所述低频率增益为0.045。使用自适应估计参数。自适应估计首先利用通过应用理论函数获得的一组值(参数)，随后在真实世界情形(例如，深砂床，粗糙的地形，和其它地形种类)下迭代测试并修改所述参数，直到使参数完美为止。
权利要求
1.一种导航和控制系统，包括配置成产生位置信号的一个或多个位置传感器，所述位置信号表示车辆的定位和航向；获得输入并产生控制车辆的运行的输出的一个或多个操作控制机构；和远离操作控制机构布置的自含式自主控制器，所述自主控制器包括，配置成从位置传感器接收位置信号，并产生定义车辆的更新的行驶路线的操作控制信号的处理器，和提供位置传感器、操作控制机构和处理器之间的通信的可编程接口，所述可编程接口被配置成使从位置传感器给处理器的输入归一化，并产生用作给操作控制机构的输入的兼容操作控制信号，从而自含式自主控制器是可配置的，以便与各种不同的传感器和不同的操作控制机构一起工作。
2.按照权利要求1所述的系统，还包括配置成产生物体信号的一个或多个物体传感器，所述物体信号指示相对于车辆的行驶路线的物体，其中处理器被配置成从物体传感器接收物体信号，从物体信号中识别相对于车辆的行驶路线固定的物体和运动的物体，和通过把识别的固定物体和运动物体以及位置信号考虑进去，产生定义所述更新的行驶路线的操作控制信号。
3.按照权利要求2所述的系统，其中可编程接口被配置成提供位置传感器、物体传感器、操作控制机构和处理器之间的通信，并被配置成使从物体传感器给处理器的输入归一化。
4.按照权利要求2所述的系统，其中物体传感器包括配置成产生所述射束并探测来自物体的射束的反射的光探测和测距装置。
5.按照权利要求2所述的系统，其中物体传感器包括配置成产生所述射束并按发射射束的波长探测来自物体的反射的激光雷达装置。
6.按照权利要求2所述的系统，其中物体传感器包括配置成提供从其识别物体的行驶路线的图像的照相机。
7.按照权利要求1所述的系统，还包括配置成把编程指令输入可编程接口的程序接口。
8.按照权利要求1所述的系统，其中处理器被配置成按照线控格式，向操作控制机构提供方向指令和/或速度控制指令，从而处理器电控发动机油门、车辆转向和车辆制动中的至少一个。
9.按照权利要求1所述的系统，还包括配置成保存沿着行驶路线的路点的逻辑地图的地图存储区，所述逻辑地图包括从一个路点到另一个路点的方向、路点的地理空间坐标、沿着车辆的行驶路线的道路的十字路口和与在不同路点之间的行驶相关的时间中的至少一个。
10.按照权利要求9所述的系统，其中用障碍物识别算法对处理器编程，以通过比较物体位置和路点的地理空间坐标，确定在车辆附近的物体是否是所述路点。
11.按照权利要求1所述的系统，其中位置传感器包括全球定位系统装置和/或惯性导航系统。
12.按照权利要求1所述的系统，其中处理器包括可变结构观测器，所述可变结构观测器被配置成识别在车辆附近的物体的位置、速度和几何形状，及时预测识别的物体的位置和速度，和估计识别的物体的未来位置。
13.按照权利要求1所述的系统，其中处理器包括路线寻找算法，所述路线寻找算法被配置成对于所述行驶路线，根据记录的两个路点之间的交通模式，确定车辆在这两个路点之间的路线。
14.按照权利要求13所述的系统，其中路线寻找算法被配置成根据记录的在两个路点之间行驶的时间、两个路点之间的拥堵区的历史和拥堵的实时报告中的至少一个，确定所述路线。
15.按照权利要求14所述的系统，其中路线寻找算法被配置成根据两个路点之间的许多特定行驶路线的相应的加权平均值，确定所述路线，相应的加权平均值包括记录的在两个路点之间行驶的时间、两个路点之间的拥堵区的历史和拥堵的实时报告中的所述至少一个。
16.按照权利要求1所述的系统，还包括配置成提供行驶路线的图像的照相机；和根据图像识别自主车辆的行驶路线的车道的所述处理器。
17.按照权利要求16所述的系统，其中所述处理器被配置成确定在识别的车道中是否存在障碍物。
18.按照权利要求1所述的系统，其中所述处理器被配置成确定固定物体和/或运动物体周围的规避路线。
19.按照权利要求18所述的系统，其中所述处理器被配置成通过预测与固定物体或运动物体碰撞的可能性，确定所述规避路线，其中作为第一动作，沿着行驶路线修改车辆的速度，以确定是否存在规避路线的第一解答；作为第二动作，当不存在第一解答时，沿着行驶路线实现所述滑模算法中的偏向机动， 以确定是否存在规避路线的第二解答；作为第三动作，当不存在第一解答或第二解答时，使车辆停下来。
20.按照权利要求18所述的系统，其中所述处理器被配置成根据利用滑模程序预测避开固定物体和运动物体的最佳轨迹的虚拟路线分析，确定所述规避路线，其中所述滑模分析被编程成根据1)从行驶路线到车辆的移动点(χ* (s), y* (s)),2) 从行驶路线到车辆的距离s (t)，和3)从移动点(x* (s(t)), y* (s(t)))到实际车辆位置 (x(t),y(t))的误差向量E(t)，产生转向命令，其中误差向量E(t)适应能够使车辆偏离行驶路线或者偏离行驶路线的接近路线的时间相关非线性因素。
21.—种车辆的导航和控制方法，包括产生表示车辆的定位和航向的位置信号；借助可编程接口使位置信号归一化，从而产生归一化的位置信号；根据归一化的位置信号，产生操作控制信号；和借助可编程接口使操作控制信号归一化，从而产生归一化的操作控制信号，归一化的操作控制信号控制车辆沿着车辆的更新的行驶路线的运行。
22.—种可驾驶单元，包括 车辆，所述车辆包括，配置成产生位置信号的一个或多个位置传感器，所述位置信号表示车辆的定位和航向；获得输入并产生控制车辆的运行的输出的一个或多个操作控制机构；和远离至少一个操作控制机构布置的自含式自主控制器，所述自主控制器包括， 配置成从位置传感器接收位置信号，并产生定义车辆的更新的行驶路线的操作控制信号的处理器，和提供位置传感器、操作控制机构和处理器之间的通信的可编程接口，所述可编程接口被配置成使从位置传感器给处理器的输入归一化，并产生用作给操作控制机构的输入的兼容操作控制信号，从而自含式自主控制器是可配置的，以便与各种不同的传感器和不同的操作控制机构一起工作。
23.按照权利要求22所述的单元，其中所述车辆包含陆基车辆。
24.按照权利要求23所述的单元，其中陆基车辆包括汽车，卡车，运动型多用途汽车， 救援车，农机车辆，采矿车，护卫车，玩具车，侦察车，试验跑道车，和装甲车中的至少一个。
25.按照权利要求22所述的单元，其中车辆包括船只。
26.按照权利要求25所述的单元，其中船只包括小船，轮船，驳船，油轮，两栖车辆，气垫船和装甲船。
27.按照权利要求22所述的单元，其中车辆包含无驾驶员辅助控制的自主车辆。
28.按照权利要求22所述的单元，其中车辆包含具有计算机辅助控制的驾驶员控制车辆。
29.按照权利要求观所述的单元，其中处理器被配置成识别驾驶员机能障碍。
30.按照权利要求四所述的单元，其中处理器被配置成根据生物特征传感器或者根据车辆的驾驶员控制的分析，识别驾驶员机能障碍。
31.按照权利要求观所述的单元，其中处理器被配置成在输入命令的情况下控制车辆。
32.一种包含供在车辆中的处理器上执行的程序指令的计算机可读介质，当被处理器执行时，所述程序指令使处理器实现下述功能接收表示车辆的定位和航向的位置信号，所述位置信号已借助可编程接口被归一化， 从而产生归一化的位置信号；根据归一化的位置信号，产生操作控制信号；和把操作控制信号输出给可编程接口，以产生归一化的操作控制信号，归一化的操作控制信号控制车辆沿着车辆的更新的行驶路线的运行。
33.一种导航和控制系统，包括获得输入并产生控制车辆的运行的输出的一个或多个操作控制机构；和根据1)从行驶路线到车辆的移动点(χ* (s), y * (s))，2)从行驶路线到车辆的距离 s(t)，和3)从移动点(x* (s(t)), y* (s(t)))到实际车辆位置(x(t), y(t))的误差向量 E(t)，产生转向命令的处理器，其中误差向量E(t)适应能够使车辆偏离行驶路线或者偏离行驶路线的接近路线的时间相关非线性因素。
34.按照权利要求33所述的系统，其中处理器被配置成根据满足d/dtE(t)= -kE(t) 形式的微分方程，并且对最佳行驶方向来说收敛到0的误差向量E(t)，确定车辆的行驶方向。
35.按照权利要求33所述的系统，其中在确定沿着行驶路线的所述移动点(χ*(s)，y* (S))时，处理器把非线性因素包括在所述确定中，所述非线性因素包括前轮速度、后轮速度、 中间的滑动程度和车辆打滑中的至少一个。
36.按照权利要求33所述的系统，其中在确定沿着行驶路线的所述移动点(χ*(s)，y* (S))时，处理器把相对于行驶路线的s(t)的时间导数包括在所述确定中，以考虑所述非线性因素。
全文摘要
导航和控制系统，包括配置成产生位置信号的位置传感器，所述位置信号表示车辆的定位和航向。系统包括获得输入并产生控制车辆的工作的输出的一个或多个操作控制机构，并且包括远离操作控制机构的自含式自主控制器。自主控制器包括配置成从位置传感器接收位置信号并产生定义车辆的更新的行驶路线的操作控制信号的处理器，和提供位置传感器、操作控制机构和处理器之间的通信的可编程接口。可编程接口被配置成使从位置传感器给处理器的输入归一化，并产生用作给操作控制机构的输入的兼容操作控制信号，从而自含式自主控制器是可配置的，以便与各种不同的传感器和不同的操作控制机构一起工作。
文档编号G01C22/00GK102227612SQ200980147195
公开日2011年10月26日 申请日期2009年10月26日 优先权日2008年10月24日
发明者A·李, J·E·纳格尔, M·T·德温特, M·T·杜内尔, N·M·特拉夫特, P·G·特帕格尼尔, P·金内, S·达拉库诺夫 申请人:格瑞股份公司