著录项信息
专利名称 | 描绘、产生、检验自动制导车辆无导线制导路线的方法和系统 |
申请号 | CN98117665.8 | 申请日期 | 1998-09-01 |
法律状态 | 权利终止 | 申报国家 | 中国 |
公开/公告日 | 1999-08-04 | 公开/公告号 | CN1224863 |
优先权 | 暂无 | 优先权号 | 暂无 |
主分类号 | 暂无 | IPC分类号 | 暂无查看分类表>
|
申请人 | 杰维斯B·韦布国际公司 | 申请人地址 | 美国密执安州
变更
专利地址、主体等相关变化,请及时变更,防止失效 |
权利人 | 杰维斯B·韦布国际公司 | 当前权利人 | 杰维斯B·韦布国际公司 |
发明人 | 康奈尔W·阿洛夫斯;罗纳尔德R·德连斯;贾斯廷R·德连斯 |
代理机构 | 中原信达知识产权代理有限责任公司 | 代理人 | 袁炳泽 |
摘要
控制一辆或多辆自动制导车辆运动的方法和系统,包括系统控制器,多个无导线自动制导车辆(AGV)和设置在地面的位置标记。控制器作为系统的调度器和交通控制器,在一实施例中,为系统中各AGV提供双向无线通信。各AGV装配一导航和制导系统,控制AGV沿预定的制导路线运动。控制器中存储的路线点数据库的差值X,Y坐标传送到一给定的AGV,使AGV沿预定路线行驶。仅传送差值X,Y坐标改进的系统能在系统内控制使用大量AGV。
1.一种控制至少一辆自动制导车辆沿制导路线运动的方法,包 括:
a)为自动制导车辆限定一沿其行驶的制导路线,该制导路线包括 多个路段,其中每个路段由带有一个始点和一个终点的直线形和曲线 形路段之一构成;
b)根据路线点数据库中的X,Y坐标识别每一个始点和终点;
c)提供一系统控制器,其使用数据库、多个具有参考X,Y坐标 并沿着该制导路线定位的参考标记、和在自动制导车辆上的导航程序, 用于控制该至少一辆自动制导车辆的运动;
d)还提供带有差值X,Y坐标的路线点数据库,每个差值X,Y 坐标基于制导路线上的第一路线点和第一路线点下游的第二路线点的 X和Y坐标之间的差值;
e)把与路线点数据库中的差值X,Y坐标相关的数据传送到至少 一辆自动制导车辆;以及
f)利用该至少一辆自动制导车辆的该系统控制器和该导航程序同 与该差值X,Y坐标相关的数据一起,来指引该至少一辆自动制导车 辆沿着每一路段的直线形或曲线形路段之一行驶。
2.根据权利要求1所述的方法,进一步包括步骤:提供包含沿一 个路段的距离和在与所述距离对应的路段上的位置的车辆位置数据 库,以及命令该至少一辆自动制导车辆,根据来自车辆位置数据库的 输入执行操作。
3.根据权利要求1所述的方法,
其中的步骤(c)进一步包括步骤:
提供包括多个参考标记的参考X,Y坐标的真实方位数据库;
其中的步骤(d)进一步包括步骤:
提供与该至少一辆自动制导车辆沿制导路线的位置有关的信息; 和
其中的步骤(e)进一步包括步骤:
根据该信息和真实方位数据库来校正该至少一辆自动制导车辆在 行进中与制导路线的任何偏差。
4.根据权利要求3所述的方法,进一步包括步骤:提供包含沿一 个路段的距离和在与所述距离对应的路段上的位置的车辆位置数据 库,以及命令该至少一辆自动制导车辆,根据来自车辆位置数据库的 输入执行操作。
5.根据权利要求1所述的方法,其中利用计算机辅助绘图系统和 人工方式之一生成制导路线。
6.根据权利要求5所述的方法,其中计算机辅助绘图系统允许与 第三方软件组合。
7.根据权利要求1所述的方法,其中的步骤(c)进一步包括步 骤:
制导至少一辆自动制导车辆通过该多个参考标记的至少两个标 记,以使该至少一辆自动制导车辆检测表示一个路段和一个给定位置 的至少两个参考标记的参考X,Y坐标,以便利接收与沿其它路段的 其它差值X,Y坐标对应的数据。
8.根据权利要求1所述的方法,进一步包括步骤:将该自动制导 车辆移动到已知方位和驶向,并将该已知方位和驶向通过代表该已知 方位和驶向的真实坐标或方位代码输入该数据库。
9.根据权利要求1所述的方法,其中该参考标记是转发器。
10.根据权利要求1所述的方法,其中该制导路线是预先规定的, 并指引该至少一辆自动制导车辆沿着未对每一路段计算新制导路线的 每一路段行驶。
11.根据权利要求2所述的方法,其中车辆位置数据库远离该至 少一辆自动制导车辆设置。
12.根据权利要求3所述的方法,其中真实方位数据库远离该至 少一辆自动制导车辆设置。
13.根据权利要求1所述的方法,其中路线点数据库远离该至少 一辆自动制导车辆设置,并且将差值X,Y坐标传送到该至少一辆自 动制导车辆。
14.根据权利要求4所述的方法,其中至少路线点数据库、车辆 位置数据库和真实方位数据库之一远离该至少一辆自动制导车辆设 置。
15.根据权利要求4所述的方法,其中所有数据库远离该至少一 辆自动制导车辆设置,或设置在该至少一辆自动制导车辆上。
16.根据权利要求1所述的方法,包括当自动制导车辆达到路 段的一个终点时向该至少一辆自动制导车辆发出程序释放命令,并利 用该路段下一个终点的X,Y差值坐标来引导该自动制导车辆沿下一 个路段行驶。
17.一种控制至少一辆自动制导车辆沿限定该自动制导车辆沿其 行驶的路线的制导路线运动的系统,包括:作为制导路线的多个路段, 其中每个路段由带有一个始点和一个终点的直线形和曲线形路段之一 构成,每个始点和终点是由路线点数据库中的一X,Y坐标识别的; 一系统控制器,其利用路线点数据库(7)、多个具有参考X,Y坐标 和沿制导路线定位的参考标记、和在该至少一辆自动制导车辆上的导 航程序,用于控制该至少一辆自动制导车辆的运动,该系统进一步包 括:
a)带有差值X,Y坐标的所述路线点数据库(7),每个差值X, Y坐标基于制导路线上的第一路线点和第一路线点下游的第二路线点 的X和Y坐标之间的差值;以及
b)所述系统控制器把差值X,Y坐标传送到该至少一辆自动制导 车辆,以使该至少一辆自动制导车辆利用该差值X,Y坐标可沿制导 路线行驶。
18.根据权利要求17所述的系统,进一步包括用于存储包含沿一 个路段的距离和在与所述距离对应的路段上的位置的车辆位置数据库 (9),以便该至少一辆自动制导车辆根据来自该车辆位置数据库的输 入执行操作的装置。
19.根据权利要求17所述的系统,进一步包括用于存储包括多个 参考标记的参考X,Y坐标的真实方位数据库(11),以便可校正该 至少一辆自动制导车辆行驶中的任何偏差的装置。
20.根据权利要求19所述的系统,进一步包括用于存储包含沿一 个路段的距离和在与所述距离对应的路段上的位置的车辆位置数据库 (9),以便该至少一辆自动制导车辆根据来自该车辆位置数据库的输 入执行操作的装置。
21.根据权利要求17所述的系统,其中所述路线点数据库(7) 远离该至少一辆自动制导车辆设置,或设置在该至少一辆自动制导车 辆上。
22.根据权利要求20所述的系统,其中至少路线点数据库、车辆 位置数据库和真实方位数据库存储装置之一远离该至少一辆自动制导 车辆设置。
23.根据权利要求17所述的系统,其中所述路线点数据库(7) 远离该至少一辆自动制导车辆设置。
24.根据权利要求17所述的系统,进一步包括用于生成存储在路 线点数据库中的制导路线的计算机辅助绘图系统。
25.根据权利要求20所述的系统,进一步包括计算机辅助绘图系 统,用于产生路线点、真实方位和车辆位置数据库的任意组合或全体。
26.根据权利要求20所述的系统,进一步包括,当自动制导车辆 达到路段的一个终点时,所述系统控制器(13)向该至少一个自动制 导车辆发出程序释放命令,并利用该路段下一个终点的X,Y差值坐 标来引导该自动制导车辆沿下一个路段行驶。
技术领域\n本发明涉及用于控制自动制导车辆运动的系统和方法,特别是根 据差值X,Y坐标的数据库使用预先规定的无导线制导路线以便沿制 导路线引导自动制导车辆的系统和方法。\n背景技术\n在现有技术中,已经提出了许多控制自动或无人驾驶车辆的系统 和方法。一种系统采用地下导线制导装置迫使自动制导车辆(AGV)沿 地下的一条或多条导线行驶。这是通过使每条导线传送不同的已知频 率的小电流实现的。导线铺设并封闭在地下挖的窄浅槽中。按系统所 希望的制导路线的要求规定由弧线和直线线段构成的挖槽。通常,使 各种弧线和直线线段相互相切,以使经过给定路线所需的转向作用力 最小。\n然后用可调感应传感器控制每辆车的转向,以使其沿所希望导线 的辐射电磁场(频率)行驶。利用不同频率描绘制导路线的不同区段,通 过告诉车辆跟随哪个频率来控制车辆的路线。\n为了知道何时转换频率,车辆还必须知道其处在沿所希望导线制 导路线的什么位置。由于地下的导线仅向车辆提供横向(转向)方位信 息,采用位置标记更新车辆沿导线制导路线的方位。这些位置标记可 以是电磁转发器、磁铁、光反射器等。在任何情况下,当一辆车经过 这样一个标记时,该辆车知道其沿导线制导路线的准确位置。又可利 用这种位置启动或命令车辆来切换频率、改变速度/方向、停驶、上人、 下人、和/或执行一个或多个许多其它可能的命令。通常,在每个具体 位置立即或延迟执行的特定操作由内部车辆程序(VP)数据库中的项目 描绘,车辆程序数据库由位置标记本身直接或间接寻址。\n另一种采用AGV的系统是无导线控制系统。在这些系统中,不 是采用地下设置的导线,而是使用位置标记和根据到控制器的一个或 多个输入管理AGV运动的系统控制器来沿制导路线引导AGV。由于 不承担在地下铺设导线的费用,这些无导线系统比导线系统提供了明 显的优点。\nYardley等人的美国专利No,5,281,901和5,341,130讲授了一种自 动制导车辆控制系统,该控制系统可与提供制导导线导航和制导以及 自动导航和制导的现有制导导线系统向下兼容,并在中央控制器和每 辆车之间进行无线通信。Yardley等人的无导线制导模式包括在地下设 置的一系列参考标记,若干无导线AGV和一个AGV中央控制器。控 制器利用其存储器中存储的制导路线分布图保持系统中每个AGV的 状态和位置的轨迹。中央控制器设有与系统内每辆AGV双向无线通信 的设备,每个AGV装配有用于控制AGV沿所选制导路线运动的无导 线导航和制导系统。在地下沿制导路线的多个点设置位置标记。这些 位置标记提供用于纠正AGV的预测当前方位的绝对方位。\n每个AGV有一个车载控制器,该控制器根据来自下一个终点路 段指定方位的X,Y坐标计算制导路线。该路段驶出点定位信息从中 央控制器传送到AGV。车载计算机首先选择制导路线计算模式,以便 根据AGV相对于路段驶出点的指定方位的当前朝向角度进行计算。一 旦选定制导路线计算模式,车载计算机根据传送的驶出点定位信息和 例如从轴编码器、陀螺仪、和位置标记确定的AGV的当前位置来计算 制导路线。\n由于AGV的位置和方向通常不象为路程点和目的地之间的路线 原来计划和存储的那样,每当一个AGV接近一个路段时计算一个新的 唯一的制导路线。用于计算路段制导路线的计算参数是制导路线必须 与AGV的当前方向相切的初始角度和制导路线必须与中央控制器提 供的驶出方位相切的驶出角度。这些专利利用五次多项式方程来计算 AGV沿其行驶的制导路线的制导点。\n从管理计算机接收到加载运动任务时,中央控制器选择一个AGV 并安排所选择AGV的最佳路线。根据安排的路线和AGV的当前位置, 中央控制器通过中央控制器和AGV之间的双向通信利用计算的制导 点通过路段控制设置路段。每个路段的长度在从AGV长度的若干分之 一到比AGV长度大的长度范围。\n设在密歇根Farmington的Jervis B.Webb公司的子公司控制工程公 司也有一个无导线AGV控制系统,该控制系统包括一台系统计算机、 一系列设置在地下的参考标志或位置标记和若干无导线AGV。系统计 算机作为该系统的调度器和交通控制器,并为系统中的每辆AGV提供 双向无线通信。AGV装配有无导线导航和制导系统,用以将AGV控 制在系统中沿着规定的制导路线。沿制导路线的多个点在地下设置位 置标记并为AGV提供绝对方位参考。\n虽然控制工程公司的系统与传统或导线制导系统相似,其制导系 统中的误差校正程序的区别在于:误差校正与由AGV车载的制导路线 计算模式提供的制导路线信息比较,而不是与从检测的制导导线返回 的数据比较。\n每个AGV的车载控制器包含用来模拟通过检测地下制导导线预 先得到的函数的数据库。该数据库包括地下位置标记方位的详细内容 和系统中每个路段终点的绝对X,Y坐标。数据库还包括就相对于一 个路线点行进的距离而言,将要进行AGV操作的系统中每个点的功能 和位置。典型的功能包括停止、操纵车载输送器,复位放行命令等。\n该数据库是通过所设计的制导路线在计算机辅助设计系统中开发 的,以使系统中的每个路段相对于相邻路段相切地衔接。对制导路线 布局的这一限制允许制导路线系统中的每个路段以其终点的绝对X,Y 坐标和基本几何形状为特征。系统中所有路段的X,Y坐标被存储在 系统中每辆AGV的数据库中。\n操作中,系统控制器向AGV传送最终目标命令和行驶路线放行 命令。最终目的命令包括车辆标识符、目标编号、和操作。车辆标识 符包含对其发出命令的具体车辆的地址。目标编号是与系统中可识别 一个输送器、一个队列、或停车地点的位置有关的编号。操作是指由 车辆执行的动作,例如鸣笛或车载输送器之类的操作。行驶路线放行 命令用来控制车辆通过系统中的路段。行驶路线识别一串将定义给该 车辆的一部分其所希望路线的路线点标志。当获准行驶路线放行时, 相关的路线点将车辆当前的线路向其最终目的地或下一个保持的停止 位置延伸。随着AGV接近行驶路线终点,系统控制器为AGV传送另 一个行驶路线放行命令。AGV将确认接收该命令并继续通过该行驶路 线。该过程将继续,直到AGV到达作为目的地命令部分传送的其最终 目的地。\n如上所述,行驶路线可以包括几个路段。AGV的车载计算机利用 从数据库检索的绝对X,Y坐标来表征为每个路段预先设计的制导路 线。AGV制导系统定期检验和校正AGV的运动,以使其沿制导路线 前进。在系统进入工作前,规定系统中所有路段的制导路线。因此, 不存在由AGV导航和制导系统完成的制导路线选择或根据来自路段 的驶出方位的计算制导路线。\n上述无导线系统并不是没有其缺陷。Yardley等人的专利中描述的 系统采用复杂的五次多项式描绘无导线制导路线。另外,由于Yardley 等人的系统在接收到驶出点方位信息时根据驶出点的X,Y坐标和驶 出方位以及车辆的实际位置继续选择和计算制导路线,如果车辆当前 的位置和/或方向误差足够大,该车辆会计算“新路线”为一个障碍。 另外,由于该系统不仅使用X,Y坐标,而且使用驶出方位,必须从 中央控制器向AGV传送大量信息,以便引导其沿无导线路线运动。该 信息负荷可限制了控制器控制的车辆数量,并且可能在系统中引起可 靠性问题和/或广播困难。\n具有使用绝对X,Y坐标的车载控制器的无导线系统遇到了需要 大量存储器以容纳数据库所需信息的要求。另外,由于需要大量信息, 从远程控制器传送该信息会造成与如上所述的Yardley等人的系统相 同的问题。\n发明内容\n鉴于现有技术中无导线系统的缺陷,已经产生提供用于控制自动 制导车辆的改进系统和方法的需求。本发明通过提供用于描绘、产生 和检验自动制导车辆的无导线制导路线的方法和系统克服了上面提到 的现有技术中的缺陷,该系统和方法模拟地下有导线制导路线的简单 弧线和直线特性,同时还足够紧凑地保持在车辆上或远离车辆的公共 系统控制器上的相对小的数据库中。\n因此,本发明的第一个目的是提供一种用于控制自动制导车辆的 改进系统和方法。\n本发明的另一个目的是提供一种用于控制自动制导车辆的系统和 方法,该系统和方法利用在车上或车下使用的紧缩数据库模拟地下制 导路线的直线和弧线特征。\n本发明的再一个目的是一种可连接制导路线绘制、产生并检验任 何类型的自动车辆的系统和方法。\n本发明的再一个目的是根据差值测量结果或计算使用X,Y坐标 而不是绝对值来使需要传送到AGV或存储在数据库中的信息最少。\n本发明的另一个目的是提供能够容易和可靠地检验制导路线偏差 以满足安全、用户和工业标准的系统和方法。\n本发明的再一个目的是一种具有多个数据库的系统和方法,该系 统和方法具有使用车上或车下应用中的一个或多个数据库的能力,从 而改善系统在通信需求和/或车辆或数据库重新编程方面的灵活性。\n本发明的其它目的和优点将随着下面的描述变得显而易见。\n为此,本发明提供了一种控制至少一辆自动制导车辆沿制导路线 运动的方法,包括:\na)为自动制导车辆限定一沿其行驶的制导路线,该制导路线包 括多个路段,其中每个路段由带有一个始点和一个终点的直线形和曲 线形路段之一构成;\nb)根据路线点数据库中的X,Y坐标识别每一个始点和终点;\nc)提供一系统控制器,其使用数据库、多个具有参考X,Y坐 标并沿着该制导路线定位的参考标记、和在自动制导车辆上的导航程 序,用于控制该至少一辆自动制导车辆的运动;\nd)还提供带有差值X,Y坐标的路线点数据库,每个差值X,Y 坐标基于制导路线上的第一路线点和第一路线点下游的第二路线点的 X和Y坐标之间的差值;\ne)把与路线点数据库中的差值X,Y坐标相关的数据传送到至 少一辆自动制导车辆;以及\nf)利用该至少一辆自动制导车辆的该系统控制器和该导航程序 同与该差值X,Y坐标相关的数据一起,来指引该至少一辆自动制导 车辆沿着每一路段的直线形或曲线形路段之一行驶。\n另外,本发明还提供了一种控制至少一辆自动制导车辆沿限定该 自动制导车辆沿其行驶的路线的制导路线运动的系统,包括:作为制 导路线的多个路段,其中每个路段由带有一个始点和一个终点的直线 形和曲线形路段之一构成,每个始点和终点是由路线点数据库中的一 X,Y坐标识别的;一系统控制器,其利用路线点数据库、多个具有 参考X,Y坐标和沿制导路线定位的参考标记、和在该至少一辆自动 制导车辆上的导航程序,用于控制该至少一辆自动制导车辆的运动, 该系统进一步包括:\na)用于存储带有差值X,Y坐标的路线点数据库的装置7,每个 差值X,Y坐标基于制导路线上的第一路线点和第一路线点下游的第 二路线点的X和Y坐标之间的差值;以及\nb)所述系统控制器把差值X,Y坐标传送到该至少一辆自动制 导车辆,以使该至少一辆自动制导车辆利用该差值X,Y坐标可沿制 导路线行驶。\n为满足上述目的和优点,本发明提供对自动车辆无导线制导系统 和方法的改进,其中至少控制一辆自动制导车辆沿制导路线运动,该 制导路线包括多个路段,其中每个路段由带有始点和终点的直线形和 曲线形路段之一构成,根据路线点数据库中的X,Y坐标识别每个点, 由系统控制器利用路线点数据库和自动制导车辆上的导航程序控制运 动。本发明的系统和方法利用带有差值X,Y坐标的路线点数据库, 每个差值X,Y坐标基于制导路线上的第一路线点和第一路线点下游 的第二路线点的X,Y坐标之间的差值。把与路线点数据库中的差值 X,Y坐标相关的数据传送到至少一个自动制导车辆以启动该至少一 个自动制导车辆的导航程序,以使该自动制导车辆沿每个路段行驶。\n该系统和方法还包括车辆位置数据库和真实方位数据库。车辆位 置数据库包含沿一个路段的距离和在与所述距离对应的路段上的位 置,以及使至少一个自动制导车辆根据来自车辆位置数据库的输入执 行操作的指令。真实方位数据库存储沿一个路段的至少一个位置标记 的实际X,Y坐标。然后,可使用车辆的导航系统根据实际的X,Y 坐标和车辆位置校正至少一个自动制导车辆在行驶中的偏差。通过误 差探测系统和在路线点数据库中预先规定的制导路线,可在现实环境 中控制任何类型的自动车辆。作为替换,转发器或类似装置可向车辆 传送用于误差校正的其真实位置。\n数据库可由车载或位于具有双向传送和接收远程操作能力的远 点。作为替换,根据所希望的自动制导车辆应用,只有某些数据库可 位于远程或可放置在车上。制导路线可人工或通过计算机辅助绘图 (CAD)系统产生。\n优选的起动过程包括提供至少两个位置标记和制导至少一个自动 制导车辆通过至少两个位置标记,以使该至少一辆自动制导车辆检测 表示一个路段和一个给定位置的实际X,Y坐标。通过该信息,该至 少一个自动制导车辆可接收与其它差值X,Y坐标对应的数据,以便 沿后面的路段行驶。起动方法还可包括根据两个位置标记确定该路段 的驶出角度,该驶出角度在用于后面的路段上行驶的导航程序中使 用。\n任何种类的已知位置标记和自动车辆可与本发明的系统和方法一 起使用。另外,由于制导路线是通过人工或CAD预先计算的,自动制 导车辆在其行驶时不需要计算制导路线。\n附图说明\n现在参考本发明的附图,其中:\n图1是说明规定路线和后续路段的几何图形的曲线图;\n图2是说明直线段的横向偏移和驶向误差几何图形的曲线图;\n图3是说明弧线段的横向偏移和驶向误差几何图形的曲线图;和\n图4是本发明典型系统的示意图。\n优选实施方式\n本发明对上述控制工程公司的方法和系统的改进在于容易向自动 制导车辆(AGV)传送信息。本发明的方法和系统模拟固定、相切、在 地下有导线制导路线的简单弧线和直线特性,同时还足够紧凑地保持 在或是在车辆上或是在作为用于向车辆传送的公共系统控制器部件的 相对小的数据库中。\n应该理解,本发明适合于任何类型的自动车辆,例如使用简单的 驶位推算、惯性制导、激光制导或任何其它类型已知或预期的那些车 辆。由于这些导航系统和它们采用的程序在本领域是熟知的,不需要 对其进行详细描述来理解本发明。\n下面对可将通常由在地下有导线制导路线和位置转发器、磁铁提 供的制导和方位信息转换成可用于制导无导线AGV的数据库形式的 方法和系统进行说明。该说明列举了使用路线点(PP)数据库、车辆位 置(VL)数据库和真实方位(RP)数据库的方法。“终”点对应于路段的 终点,“始”点对应于路段的起点。PP数据库包括表示路段“终”和 “始”点的差值X,Y坐标,它是直线或者弧线段。如上所述,PP和 VL数据库可与VP数据库一起使用,以便完全描绘和控制理想的无导 线系统。为完全控制现实或非理想的无导线系统,应使用含有用于校 正与测量结果和/或诸如轮胎磨损、车辆载重之类的物理变化有关的导 航误差的数据的RP数据库。下面描述的方法和系统是实现本发明目的 的一种优选方式。本领域技术人员可使用采用在此描述的本发明概念 的其它方式。\n通过向系统中使用的每个路线点指定一个任意数,即标志来定址 PP数据库。虽然每个标志数可以完全随机,它们应该是唯一的,最好 是连续的,并且在某些实用数值限制内,以使任何特定PP数据库的规 模最小。\nPP数据库包含构成所需制导路线的每条直线和/或弧线段终点的 系统X,Y坐标。通过附加的系统限定,由于制导路线总是以直线段 开始,并且各自后面跟有直线或弧线段的“始”和“终”端点完全仅 由其最终的,即“终”端点的X,Y坐标限定,而不需要驶向和/或方 位角。参考图1,可对此证明如下:\n给出一个新路线点标志和其X,Y坐标(X_Pos_New和 Y_Pos_New),即X1,Y1或X2,Y2,确定新路段相对于上一个路线点 标志和其X,Y坐标(X_Pos_Old和Y_Pos_Old),即X0,Y0或X1,Y1 是直线还是弧线。同时辨别上一个路段的“驶出角度”(θ_Old)。\n应该指出,初始θ_Old角来自最初“插入”直线路段的“始”和 “终”点并计算如下:\nθ_Old=Arctan((To_X-Form_X)/(To_Y-From_Y))\n其中,From代表“始”;To代表“终”。\n根据新路段的“驶入角度”(θ_New)和上一个路段的“驶出角度”, 可确定它们是否相等或在合理偏差范围内相等。例如,由于该检验被 证明是两个角度的最有效字节的简单测试,可使用±1.4度(360°/256) 的公差,即一圈(360°)除以28。如果两个角度在给定公差范围内匹配, 则可假设新路段是直线,车辆将立即向新路线点。\n如果两个角度在给定公差范围内不匹配,则可假设新角度尖头指 向所需弧段的“弦”。然后可算出上一个路段的驶出角度与该弧段的 弦的角度之间的差(θ_Dif)。将该差值加倍并加到上一个弧段的驶出角 度。然后定义该新驶向为新弧线段的驶出角度(θ_New)。\n确定新路段类型的计算如下:\n DXN_Dist=X_Pos_New-X_Pos_Old(=ΔX新距离)\n DYN_Dist=Y_Pos_New-Y_Pos_Old(=ΔY新距离)\n在某些情况下,可以给定DXN_Dist和DYN_Dist的值或用全部 新X,Y的位置代替(传送),以便解省传送时间和/或存储空间。由于 相邻路线点之间常用的“Δ距离”不必覆盖系统的整个范围,可以采 用一个更小(更快)的编号系统。例如,对于一英寸的1/16的分辨率, 可由16比特二进制字(两字节)覆盖一个正/负170英尺的路段,而以相 同的分辨率覆盖常用系统的两个绝对X和Y值需要一个24比特的值 (三字节)。\n继续确定下一个路段是直线还是弧线,其中“Tol”代表如上所述 公差的计算如下:\n θ_Old=上一个路段的“驶出角度”\n θ_New=Arctan(DXN_Dist/DYN_Dist)\n 如果(θ_Old-Tol)≤θ_New≤(θ_Old+Tol)\n 则,新路段表示直线\n如果不满足上述条件,新路段则是弧线\n可存储常用路线点数据库如下:\n 标志n-1:路线点n-1的X坐标\n 路线点n-1的Y坐标\n 标志n: 路线点n的X坐标\n 路线点n的Y坐标\n 标志n+1:路线点r+1的X坐标\n 路线点n+1的Y坐标\nVL数据库包含到发生所需操作的路段的距离,即该数据库提供把 “位置标记”提供给如上所述的地下有导线系统的信息。VL数据库中 的每项包含路段的“始”和“终”标志,从“始”点到所需“位置” 点的路段的距离以及“位置”编号。该位置编号又用作包含待进行的 操作的VP数据库项的地址。另外,虽然每个位置编号可以完全随机, 它们应该最好是连续的,并且在某些实用数值限制内,以使任何特定 VP数据库的规模最小。同样,诸如特定速度请求、喇叭开/关、方向 灯开/关等之类的公共特性的任何复制物都应共用公共的“位置”编 号。\n可存储常用VL数据库如下:\n “始”标志:“终”路线点标志\n 到路段的距离\n 位置编号\n “终”路线点标志\n 到路段的距离\n 位置编号\n “始”标志:“终”路线点标志\n 到路段的距离\n 位置编号\n “终”路线点标志\n 到路段的距离\n 位置编号\n通过监测从导航程序反馈的数据来选择VL数据库的项,导航程 序连续提供到沿有效路段的“始”和“终”标志的有效路段的当前距 离。只要“始”与“终”标志以及当前与所希望距离在某一预先规定 的公差范围内都匹配,给定的位置编号将用作VP数据库中的目录。然 后用适当的VP数据库项确定所请求的操作,如同在地下导线系统读取 “位置标记”。\n如上所述,“真实方位”(RP)数据库将包含用于校正在任何真实 情况中出现的不可避免的导航误差。通常,该数据库包含应用于校正 车辆方位的更新标记,即磁铁、转发器、反射器等的真实物理X,Y 系统坐标。当使用诸如磁铁或反射器之类的识别方位标记时,则间接 地,即根据车辆的目前估算位置和方位标记的出现来检索数据库。然 而,在专门标志的转发器的情况下,可通过标记的接收码直接检索RP 数据库。作为替换,如果转发器被编程以便直接向车辆传送其真实X, Y位置,可完全取消RP数据库。\n给出如上面所述的方法、算法、和数据库说明,应设计常用无导 线系统如下。设计满足所希望行驶线路和指定工作通过量要求的制导 路线。由于这是一项很容易由计算机绘图包处理的任务,应懂得设计 阶段仅使用许多商业绘图软件包中的一种进行处理。当考虑到用这些 软件包允许扩充和/或改进现有设计的便利时更是如此。\n然而,使用适宜的商业绘图软件包来设计无导线制导路线有一个 更大的优点。诸如AutoDesk的AutoCAD之类的某些软件包允许带有 全存取有效制图的内部数据库的第三方软件组合。第三方软件可增加 自动文件检验(例如确认所有直线和/或弧线段相切,检验最大距离和/ 或角度等),和自动PP、VL、VP,以及,如果需要,从制图信息和/ 或附加上弹屏幕菜单增加RP数据库文件生成。\n为给出如上生成的完整数据库文件,常用的无导线系统应按如下 操作。首先必须将车辆引入系统。这可通过多种方式进行,方式之一 是将车辆移动到已知方位和驶向,然后通过真实的坐标和角度或表示 已知真实数据的方位码将该情况输入系统。优选方法是在两个方位转 发器范围内人工制导每辆车。通过读取两个转发器的X,Y方位接收 的数据通过提供足够信息把车辆“插入”该系统,以使车辆能确定其 自己的方位、驶向,并间接确定其当前“车辆位置编号”。\n一旦将所需要的车辆插入系统,在请求车辆行驶时,它们将接收 附加制导路线点。随着对每个附加路线点的接收,车辆将对其进行核 查以确定其是直线还是弧线,如上所述。\n在接收、检查并登记每个新路线点时,设定“ARC_SEG”比特表 示“弧线段”,复位表示“直线段”。然后,必须如下计算附加信息 并如下保存每种类型的路段(由车辆导航程序使用该数据)。\n如果是“Line_Seg”,则需要计算和保存如下:\n SEG_TOTAL=平方根(DXN_Dist2+DYN_Dist2)\n FINAL_VEL=最大速度(迫使编号系统最大)\n SIN_T_NEW=Sin(θ_NEW)\n COS_T_NEW=Cos(θ_NEW)\n (θ_NEW从上面得到)\n如果是“ARC_SEG”,则需要计算并保存如下:\n θ_Dif=θ_NEW-θ_Old\n θ_NEW=θ_Old+(2*θ_Dif)\n ARC-SIGN=+1,如果θ_Dif为正\n 或=-1,如果θ_Dif为负\n SIN_T_NEW=Sin(θ_NEW)\n COS_T_NEW=Cos(θ_NEW)\n RADIUS=|(X_Pos_Old-X_Pos_NEW)|/\n |[Sin(θ_Old)-Sin(θ_NEW)]|\n 或=|(Y_Pos_Old-Y_Pos_NEW)|/\n |[Cos(θ_Old)-Cos(θ_NEW)]|\nRAD_X_POS=X_Pos_New-Arc_Sign*Radius*Sin(θ_NEW)\nRAD_Y_POS=Y_Pos_New+Arc_Sign*Radius*Cos(θ_NEW)\nTHETA_BEG=θ_Old-Arc-_Sign*90\nSEG_TOTAL=π*Radius*Arc_Sign*(θ_NEW-θ_Old)/180\n最后,计算允许该“ARC”路段的最大速度(取决于弧线半径和车 辆可编程的最大转弯加速度/减速度,Turn_AccDec)。\n FINAL_VEL=平方根(Turn_AccDec*Radius)\n应该指出,上面计算的Final_Vel(直线和弧线段)在新路段的 Final_Vel设定为零时被作为前一路段的最终速度存储。由于将其作为 前一段的最终、或驶出速度处理,这将作为新路段的最大驶入速度。 同样,理想的车辆总是注视当前确定的路线的终点,以便在“路线的 终点”前减速和停止。这些情况下,车辆总是在当前确定路线的终点 完全停止。该特性保证车辆在已行驶完“放行路线”的所有路线点时, 不会失去制导或越过允许的制导路线。\n一旦已登记了如由新路线点表示的新路段,则可为导航程序提供 下列数据:Seg_Total、θ_New、Final_Vel、Sin_T_New、Cos_T_New 以及Radius_X_Position、Radius_Y_Position、θ_Beg、Arc_Sign、和 Radius,如果下一段是弧线。\n如果提供多个路线点先入先出(FIFO)缓冲器(优选情况,以便提供 平滑和连续的段与段之间的行驶操作),每段的登记数据应保持路线点 的X,Y位置和标志数据,直到导航程序需要。随着每个路段被行驶 完,即超过该段总距离行驶值“Seg_Total”,由一组数据提出缓冲器, 使下一段自动有效。\n假设标准的“当前方位和驶向”程序正在通过轴编码器和/或陀螺 仪跟踪车辆的实际进程,可从理想路线计算车辆的横向偏差和驶向误 差如下:\n给出“θ_New”(当前路段的最终驶向),和其正弦和余弦值,当 前路段的总距离(Seg_Total)和车辆的当前位置(Cur_X_Pos,Cur_Y_Pos) 和驶向(Cur_Heading),可计算车辆当前的横向偏差(Offset_Err)和驶向 误差(θ_Err)。同样,也确定行驶的距离(Cur_Distance)和当前直线或弧 线路段剩余的距离(Rem_Distance)。\n直线段导航的解法(参考图2)\n DXV_Dist=X_Pos_New-Cur_X_Pos\n DYV_Dist=Y_Pos_New-Cur_Y_Pos\n δ_Seg=DXV_Dist*Cos(θ_New)+DYV_Dist*Sin(θ _New)\nOFFSET_ERR=DYV_Dist*Cos(θ_New)-XV_Dist*Sin(θ _New)\nθ_ERR=θ_New-Cur_Heading\nCur_Distance=Seg_Total-δ_Seg\nRem_Distance=δ_Seg\n当剩余距离为零或负时,假设已行驶完该路段。然后,当 Rem_Distance≤0时,设定Seg_Done标记。\n弧线段导航解法(参考图3)\n为计算弧线段,应该指出,同样给出θ_Beg、Arc_Sign、Seg_Total、 Radius和弧线的中心点,即(Rad_X_Pos,Rad_Y_Pos)(通过如上所述的 “登记程序”预先计算)。\n DXV_Dist=Cur_X_Pos-Rad_X_Pos\n DYV_Dist=Cur_Y_Pos-Rad_Y_Pos\n Veh_Total=平方根(DXV_Dist2+DYN_Dist2)\n OFFSET_ERR=Arc_Sign*(Veh_Total-Radius)\n θ_Rad=Arctan(DYV_Dist/DXV_Dist)\n θ_ERR=θ_Rad+(9θ°*Arc_Sign)-Cur_Heading\n δ_Seg=π*Radius*Arc_Sign*(θ_Rad-θ _Beg)/180\n CUR_DISTANCE=δ_Seg\n REM_DISTANCE=Seg_Total-δ_Seg;\n当剩余距离为零或负时,假设已行驶完该路段:然后,当 Rem_Distance≤0时设定Seg_Done标记。\n对于正确地算出用于检测在“弧线段(Arc_Segment)”上运行的距 离的CUR_DISTANCE和REM_DISTANCE的符号,上面给出的弧线 段算法需要所有弧线段小于正或负360度(即目前规定,连续的360° 驶向无符号限制)。\n给出车辆的当前偏移和驶向误差,可使用适当的标准转向算法产 生转向校正命令,以便再次减小横向偏移和/或驶向误差。可以要求该 转向算法可适合于任何类型车辆轴距/轨迹。同样了解,普通算法包括 所有类型的车辆轨迹以及允许车辆偏航行驶和/或固定驶向运动。\n图4示出使用远离AGV的PP、VL、和RP数据库的典型系统。 具体地说,由参考标号10标识的系统用单一的AGV1表示,但可使用 多辆车。在图4的实施例中,示出AGV1,带有车载导航系统3和车 辆程序数据库5。如上所述,车辆程序数据库同样可位于远端,从而使 用无线通信。该系统还示出了路线点数据库7,车辆位置数据库9和远 离AGV的实际方位数据库11。三个数据库7、9和11与远离AGV的 系统控制器13通信。系统控制器13与AGV双向通信。图4还示出了 可用来向路线点数据库7和系统控制器13提供数据的CAD系统15。 另外,通过改变各个数据库的位置来变换图4描绘的实施例,以便一 个、一些、或所有数据库装在AGV上或与其远离。最后,由参考编号 17标识用于误差校正的位置标记并与系统控制器13和AGV1通信。\n本发明用于控制AGV的方法和系统比现有技术的系统提供了明 显的优点。首先,利用差值X,Y坐标大大减少了车载数据库或远端 数据库中所需的协助将AGV定向在车辆的预定线路上的存储器。在传 送数据时,由于要传送的数据较少而允许控制更多AGV,系统可靠性 更好,该优点特别重要。本发明不需要输入或传送方向或方位信息到 AGV,从而简化了整个控制过程。\n组合预先规定的制导路线系统和误差校正系统允许使用任何类型 的自动车辆。另外,由于可根据AGV的预定用途将各个数据库设置在 远端或装在车上,从而增加了灵活性。如果打算人工操作,可将数据 库和控制器设置在AGV上,以便操作者可在特定站通过输入放行所需 制导路线点的命令来命令车辆行驶到下一个所希望的站。\n所有数据库可设置在一个远端系统控制器中,控制器根据需要放 行新制导路线。通过这种安排,由于可针对一个控制器而不是每辆车 中的数据库重新编程,从而提供了最大的灵活性。\n在另一种替换中,可用车载的剩余数据库远程存储包含制导路线 的路线点的数据库。当用本实施例改变制导路线时,不必重新对车辆 编程,用最小的通信必要条件实现制导路线的高度灵活性。\n利用CAD系统生成制导路线,可利用简单的、可定义的规则来检 验制导路线制图,而不需要实际的系统和/或车辆。一旦设计了有效路 线,可从所检验的制图直接生成所需的数据库。制导路线描绘方法和 控制方案适用于可靠的“安全制导”检验。例如,如果车辆在“所希 望”路线周围±6英寸的观察窗外侧行驶,ANSI规格要求无导线车辆 “E停止(E-stop)”。通过监测OFFSET_ERR值的绝对值大于6英寸并 确认CUR_DISTANCE和REM_DISTANCE两者的值保持大于负6英 寸很容易检验该条件。\n因此,已借助于达到如上所述的本发明每一个目的的优选实施例 公开了本发明,并提供一种用于控制自动制导车辆的新的改进方法和 系统。\n本领域技术人员在不脱离本发明的精神和范围的情况下可根据本 发明的讲授设想其变化、改进和变换。因此,本发明仅由所附权利要 求的条款限定。
法律信息
- 2013-10-30
未缴年费专利权终止
IPC(主分类): G05D 1/02
专利号: ZL 98117665.8
申请日: 1998.09.01
授权公告日: 2004.07.07
- 2004-07-07
- 2000-11-15
- 1999-08-04
引用专利(该专利引用了哪些专利)
序号 | 公开(公告)号 | 公开(公告)日 | 申请日 | 专利名称 | 申请人 | 该专利没有引用任何外部专利数据! |
被引用专利(该专利被哪些专利引用)
序号 | 公开(公告)号 | 公开(公告)日 | 申请日 | 专利名称 | 申请人 | 该专利没有被任何外部专利所引用! |