CN113003229B - 一种面向异构特性大型装备多智能体协同自主转运系统 - Google Patents

Abstract

一种面向异构特性大型装备多智能体协同自主转运系统，包括主控制器、指令接收及处理模块、导航单元、组合拼接路径规划模块、无线控制模块以及多个智能体。本发明通过多智能体自主路径规划和协同作业实现高端装备高效转运精准配送，以适应高端装备转运精准配送过程中产品的多样性和异构性需求，提升装备柔性化和适应程度，实现智能装备协同作业在精准转运精准配送与装配制造环节高效应用。以多元化自适应执行装备和转运模式实现柔性化、高效化转运精准配送过程创新应用。

Description

一种面向异构特性大型装备多智能体协同自主转运系统

技术领域

本发明涉及一种面向异构特性大型装备多智能体协同自主转运系统，具备单智能体独立运行作业及多智能体协同作业能力，具备室内外无人自主导航及定位能力。

背景技术

在高端装备转运过程中产品往往具有尺寸大、重量大、运输困难等特点，超出现有常规转运设备尺寸、承载、精度的能力范围。同时，现有常规转运装备转运能力，转运效率较低，兼容性差，其转运模式缺乏灵活性、柔性化和集成化的系统解决方案，无法满足高质量、高效率、柔性化的智能转运要求，成为制约高端装备广泛应用的瓶颈问题。

发明内容

本发明的技术解决问题是：克服现有技术的不足，提供了一种面向异构特性大型装备多智能体协同自主转运系统，实现了高端装备高效化、柔性化、通用化转运，以适应高端装备超出现有单一转运设备尺寸、承载能力范围的转运需求，提升装备柔性化和适应程度，减少已往产品转运过程中的人力劳动，缩短产品转运时间。

本发明的技术解决方案是：

一种面向异构特性大型装备多智能体协同自主转运系统，包括：主控制器、指令接收及处理模块、导航单元、组合拼接路径规划模块、无线控制模块以及多个智能体；

指令接收及处理模块接收外部输入的控制指令，该控制指令包括转运系统的运动指令及拼接模式，并将转运系统的运动指令及拼接模式发送给主控制器；主控制器将所述运动指令发送给导航单元，导航单元根据转运系统当前位置的实测值以及接收到的运动指令进行导航解算，生成转运系统总体偏航角、速度以及旋转角速度，并反馈给主控制器；

主控制器将拼接模式以及导航单元反馈的运动参数发送给组合拼接路径规划模块，组合拼接路径规划模块根据拼接模式，将转运系统总体的运动参数分解为各智能体的理论运动参数，并通过无线控制模块发送给对应的各个智能体；各个智能体根据接收到的自身的理论运动参数，结合本智能体当前的位姿信息以及通过无线控制模块获得的其他智能体的位姿信息，进行轨迹规划的闭环补偿，生成实际运动参数，当前智能体按照该实际运动参数进行运转，从而实现多个智能体的协同自主转运。

进一步的，所述指令接收及处理模块接收的外部输入控制指令，来自于手持器发送的手动控制指令或者来自于外部调度系统的自动控制指令。

进一步的，导航单元包括：导航控制模块、导航传感器接收模块、视觉导航传感器、激光导航传感器以及iGPS导航传感器；

视觉导航传感器采集标识物与视觉导航传感器之间的局部相对位置信息；激光导航传感器和iGPS导航传感器采集传感器自身在全局坐标系下的坐标信息和姿态角；导航传感器接收模块接收三种传感器的输出结果并提供给导航控制模块；

当需要的定位精度在1mm～5mm之间时，导航控制模块对所述局部相对位置信息进行坐标转换，得到整体转运中心在局部坐标系下的相对坐标和姿态角，并根据得到的相对坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度，反馈给主控制器；所述局部坐标系是指以标识物的中心为原点建立的坐标系；

当需要的定位精度大于等于5mm时，导航控制模块对激光导航传感器采集的传感器自身在全局坐标系下的坐标信息和姿态角进行坐标转换，得到整体转运中心在全局坐标系下的坐标和姿态角；并根据得到的坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度，反馈给主控制器；所述全局坐标系是指：以智能体转运场地的顶点为原点建立坐标系；

当需要的定位精度小于等于1mm时，导航控制模块对iGPS导航传感器采集的传感器自身在全局坐标系下的坐标信息和姿态角进行坐标转换，得到整体转运中心在全局坐标系下的坐标和姿态角；并根据得到的坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度，反馈给主控制器。

进一步的，外部输入控制指令中的转运系统的运动指令，具体包括：目标坐标X、目标坐标Y、目标角度θ、运行指令以及运行模式；

目标坐标X、目标坐标Y和目标角度θ为全局坐标系下的位置，运行指令包括停车、前进、后退、右横行、左横行、逆时针旋转90°以及顺时针旋转90°；运行模式包括紧急停车模式和常规模式；紧急停车模式是指整个转运系统即刻停止运行；常规模式是指转运系统按照指令正常运行的模式。

进一步的，外部输入控制指令中的转运系统的拼接模式，具体包括：L型拼接、品型拼接、双车拼接以及四车拼接；

L型拼接是指三个智能体按照L形排列的形式；品型拼接是指三个智能体按照品形排列的形式；双车拼接是指两个智能体按照横向或纵向并排的形式排列；四车拼接是指四个智能体按照矩形排列的形式。

进一步的，所述组合拼接路径规划模块根据拼接模式，将转运系统总体的运动参数分解为各智能体的理论运动参数，具体包括如下步骤：

(1)以整体转运中心O为理论形心，计算各个智能体中心点到整体转运中心O的相对位姿；

(2)当拼接整体以姿态(υ_x,υ_y,ω_z)进行运动时，在坐标系XOY中，计算单位时间Δt内各个智能体中心的位置增量；坐标系XOY是以整体转运中心O为圆心的坐标系；

(3)计算拼接整体转运过程中各智能体的实时理论运动数据。

进一步的，

首先将多智能体进行编号i＝1,2,……n，当已知拼接模式下第i个智能体中心O_i相对选取整体转运中心点O之间的位姿为

其中/>

为第i个智能体中心O_i相对整体转运中心点O之间的距离，/>

为第i个智能体中心O_i相对整体转运中心点O之间的角度；

单位时间Δt内第i个智能体中心的X向、Y向以及角度增量(Δs_xi,Δs_yi,Δθ_zi)分别为：

则可知拼接整体转运过程中第i个智能体的实时理论运动数据(υ_xi,υ_yi,υ_ωi)为：

进一步的，所述智能体为基于麦克纳姆轮的转运平台，每个智能体上均设置有运动轨迹规划及闭环控制模块、位姿测量传感器接口模块、以及位姿测量传感器组合；

位姿测量传感器接口模块接收测量传感器组合采集的智能体当前位姿信息，提供给运动轨迹规划及闭环控制模块，运动轨迹规划及闭环控制模块根据外部输入的智能体自身的理论运动参数，结合本智能体当前的位姿信息以及通过无线控制模块获得的其他智能体的位姿信息，进行轨迹规划的闭环补偿，生成实际运动数据。

进一步的，位姿测量传感器组合包括激光测距传感器、激光二维雷达以及二维光电传感器PSD；激光测距传感器用于测量相邻两个智能体之间的距离，激光二维雷达用于测量相邻两个智能体之间的相对姿态和角度，二维光电传感器PSD用于测量相邻两个智能体之间的姿态偏差。

进一步的，所述运动轨迹规划及闭环控制模块进行轨迹规划的闭环补偿，生成实际运动参数，具体为：

S1、将多智能体中最前端的智能体作为主智能体，其它作为从智能体；

S2、主智能体按照该智能体理论运动参数进行运动，其它从智能体根据与主智能体的位姿偏差进行运动补偿；

S3、每个从智能体在主智能体的后端面选取一个参考点；并确定每个从智能体与该从智能体所选参考点之间的位姿作为初始位姿；

S4、在多智能体协同转运过程中，每个从智能体实时获取该从智能体与该从智能体所选参考点之间的位姿作为实时位姿；

S5、根据所述初始位姿和实时位姿进行位姿偏差计算，确定每个从智能体与主智能体的位姿偏差；

S6、对每个从智能体，设定位姿调整阈值，然后利用位姿偏差与阈值计算位姿偏差百分比；

S7、选取所有百分比中的最大值，然后进行归一化后，确定每个从智能体的调整幅值；

S8、对每个从智能体，利用调整幅值进行每个方向幅值的耦合重计算；利用耦合重计算结果建立各方向的控制律；然后设定插补间隔，利用耦合重计算结果、控制律确定各方向的插补增量；最后设定控制阈值，利用插补增量确定的生成从智能体补偿运动参数(Δυ_xi，Δυ_yi，Δυ_ωi)；

S9、根据从智能体补偿运动参数和从智能体理论运动参数累加生成从智能体实际运动参数(υ'_xi，υ'_yi，υ'_ωi)：

进一步的，利用S8中所述的补偿运动参数，确定每个从智能体的各轮转速。

进一步的，S8中，对每个从智能体，利用调整幅值进行每个方向幅值的耦合重计算时，根据高度方向的调整幅值，对其他方向的位姿调整偏差进行重计算，获得重计算后的各方向调整幅值；

利用重计算后的各方向调整幅值建立各方向的控制律；

利用重计算后的各方向调整幅值建立各方向的控制律时，首先对重计算后的各方向调整幅值进行归一化，然后建立各方向的指数趋近律。

进一步的，S8中，当插补间隔大于控制阈值时，运动控制量逐渐增大；当插补间隔不超过控制阈值时，运动控制量逐渐减小。

本发明与现有技术相比的有益效果是：

(1)本发明对激光导航技术、iGPS高精度空间定位技术以及视觉测量等多导航技术进行融合，实现面向智能车间大空间范围内全局场景下的连续导航与高精度空间定位能力；

(2)本发明通过多智能体异型编组协同转运，实现转运设备同时兼容大型异构产品和常规产品转运的能力，解决高端装备转运过程中产品的多样性和异构性需求；提升装备柔性化和适应程度，减少已往产品转运对接过程中的人力劳动，缩短产品转运时间，实现智能装备协同作业在精准转运对接与装配制造环节高效应用。

(3)本发明采用多智能体间多智能体运动态势感知和实时在线运动轨迹补偿，智能体根据自身状态与轨迹预期进行实时在线分析，并进行在线轨迹补偿，实时监听运行故障状态进行整体保护措施，实现自主健康管理和在故障状态下的重规划能力。

(4)本发明以多元化自适应执行装备和转运模式实现柔性化、高效化转运对接过程创新应用，为大型重载产品的装运对接方式提供更好的解决措施。

(5)基于多智能体协同作业方式具有转运精度高、自适应组合、作业方便快捷等特点。

(6)多智能体协同作业时通过基于激光扫描雷达轮廓识别位姿测量系统周期性测量相对位姿，并与初始设定位姿进行偏差计算；多智能体之间通过5G网络实现运动指令、补偿参数和状态参数数据的快速无线交互；通过对多智能体的各轴实时位姿偏差进行互约束性分析，并根据分析结果建立相应的位姿补偿调节控制策略，实现多智能体协同转运时的在线位姿补偿调节。

(7)本发明保证了多智能体协同转运过程的实时相对位姿控制精度。结合多智能体的自主异型编队协同控制技术，可以自适应多样性和异构型高端装备产品的柔性化转运对接，实现多智能体协同的高效率、通用化转运对接作业。采用该发明方法，解决了大型异构高端装备在狭小空间内的高效率转运、对接作业以及高精度定位问题。

附图说明

图1为本发明多智能体主要组合拼接方式示意图，其中，(a)为L型三车拼接，(b)为品型三车拼接、(c)为双车拼接，(d)为四车拼接；

图2为本发明与图1四种拼接模式相对应的旋转中心选择示意图；

图3为本发明系统架构示意图；

图4为本发明系统整体数据流图；

图5为本发明品型拼接多智能体布局示意图；

图6为本发明多智能体协同转运过程中的相对位姿测量示意图。

具体实施方式

下面结合附图对本发明的具体实施方式进行进一步的详细描述。

面向超大型载荷或者狭小异构空间内灵活转运需求，需要突破基于全向智能装备的多智能体协作和自主异型编队协同控制技术，具备基于多车异型编组及协同控制能力，实现高端装备高效化、柔性化、通用化转运，研制通用化转运平台，以适应高端装备产品转运多样性和异构性的要求，提升装备转运柔性化和适应程度，实现智能装备协同作业精准转运。

此外，构建转运全局场景下连续导航与面向精准配送环节的高精度空间定位方法，既满足产品的跨厂房、跨区域联合转运，又满足关键工位处的高精度定位，结合多传感器信息融合技术增强系统感知能力，增强数据的可信度，提高精度，扩展系统时间、空间覆盖率，增加系统的实时性和信息利用率等。保证高端装备在复杂环境中自动化转运精准配送过程的稳定可靠，提升现有设备装配精准配送过程执行效率与可靠性。

本发明涉及的面向异构特性大型装备多智能体协同自主转运系统既具备单车作业及多体协同作业能力，又具备室内外无人自主导航及定位能力。

如图3、图4所示，本发明提出的一种面向异构特性大型装备多智能体协同自主转运系统，包括：主控制器、指令接收及处理模块、导航单元、组合拼接路径规划模块、无线控制模块以及多个智能体；

指令接收及处理模块接收外部输入的控制指令，该控制指令包括转运系统的运动指令及拼接模式，并将转运系统的运动指令及拼接模式发送给主控制器；主控制器将所述运动指令发送给导航单元，导航单元根据转运系统当前位置的实测值以及接收到的运动指令进行导航解算，生成转运系统总体偏航角、速度以及旋转角速度，并反馈给主控制器；

主控制器将拼接模式以及导航单元反馈的运动参数发送给组合拼接路径规划模块，组合拼接路径规划模块根据拼接模式，将转运系统总体的运动参数分解为各智能体的理论运动参数，并通过无线控制模块发送给对应的各个智能体；各个智能体根据接收到的自身的理论运动参数，结合本智能体当前的位姿信息以及通过无线控制模块获得的其他智能体的位姿信息，进行轨迹规划的闭环补偿，生成实际运动参数，当前智能体按照该实际运动参数进行运转，从而实现多个智能体的协同自主转运。

指令接收及处理模块接收的外部输入控制指令，来自于手持器发送的手动控制指令或者来自于外部调度系统的自动控制指令，具体包括如下步骤：

(1)当为自动控制指令时，启动导航单元，解析自动导航指令，生成转运系统总体偏航角、速度以及旋转角速度(θ,υ,ω_z)，反馈给主控制器；

(2)当为手动控制指令时，解析手执器指令，获取车体运行的转运系统总体偏航角、速度以及旋转角速度(θ,υ,ω_z)，反馈给主控制器。

如图3所示，导航单元包括：导航控制模块、导航传感器接收模块、视觉导航传感器、激光导航传感器以及iGPS导航传感器；

视觉导航传感器采集标识物与视觉导航传感器之间的局部相对位置信息；激光导航传感器和iGPS导航传感器采集传感器自身在全局坐标系下的坐标信息和姿态角；导航传感器接收模块接收三种传感器的输出结果并提供给导航控制模块；

当需要的定位精度在1mm～5mm之间时，导航控制模块对所述局部相对位置信息进行坐标转换，得到整体转运中心在局部坐标系下的相对坐标和姿态角，并根据得到的相对坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度，反馈给主控制器；所述局部坐标系是指以标识物的中心为原点建立的坐标系；

当需要的定位精度大于等于5mm时，导航控制模块对激光导航传感器采集的传感器自身在全局坐标系下的坐标信息和姿态角进行坐标转换，得到整体转运中心在全局坐标系下的坐标和姿态角；并根据得到的坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度(θ,υ,ω_z)，反馈给主控制器；所述全局坐标系是指：以智能体转运场地的顶点为原点建立坐标系；

当需要的定位精度小于等于1mm时，导航控制模块对iGPS导航传感器采集的传感器自身在全局坐标系下的坐标信息和姿态角进行坐标转换，得到整体转运中心在全局坐标系下的坐标和姿态角；并根据得到的坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度(θ,υ,ω_z)，反馈给主控制器。

外部输入控制指令中的转运系统的运动指令，具体包括：目标坐标X、目标坐标Y、目标角度θ、运行指令以及运行模式；

目标坐标X、目标坐标Y和目标角度θ为全局坐标系下的位置，运行指令包括停车、前进、后退、右横行、左横行、逆时针旋转90°以及顺时针旋转90°；运行模式包括紧急停车模式和常规模式；紧急停车模式是指整个转运系统即刻停止运行；常规模式是指转运系统按照指令正常运行的模式。

如图1所示，外部输入控制指令中的转运系统的拼接模式，具体包括：L型拼接、品字型拼接、双车拼接以及四车拼接；

L型拼接是指三个智能体按照L形排列的形式；品字型拼接是指三个智能体按照品形排列的形式；双车拼接是指两个智能体按照横向或纵向并排的形式排列；四车拼接是指四个智能体按照矩形排列的形式。

组合拼接路径规划模块根据拼接模式，将转运系统总体的运动参数分解为各智能体的理论运动参数，具体包括如下步骤：

(1)以整体转运中心O为理论形心，计算各个智能体中心点到整体转运中心O的相对位姿；

(2)已知转运系统总体偏航角、速度以及旋转角速度为(θ,υ,ω_z)，可转换为拼接整体运行姿态(υ_x,υ_y,ω_z)，如下：

(3)当拼接整体以姿态(υ_x,υ_y,ω_z)进行运动时，在坐标系XOY中，计算单位时间Δt内各个智能体中心的位置增量；组合拼接方式如图1所示，同时自定义组合拼接时的整体转运中心，整体转运中心一般定义为拼接整体几何中心、各单智能体中心或拼接连线的中心，如图2所示；坐标系XOY是以整体转运中心O为圆心的坐标系；

首先将多智能体进行编号i＝1,2,……n，当已知拼接模式下第i个智能体中心O_i相对选取整体转运中心点O之间的位姿为

其中/>

为第i个智能体中心O_i相对整体转运中心点O之间的距离，/>

为第i个智能体中心O_i相对整体转运中心点O之间的角度；

单位时间Δt内第i个智能体中心的X向、Y向位置增量以及角度增量(Δs_xi,Δs_yi,Δθ_zi)分别为：

(4)计算拼接整体转运过程中各智能体的实时理论运动数据。

可知拼接整体转运过程中第i个智能体的实时理论运动数据(υ_xi,υ_yi,υ_ωi)为：

本发明所述智能体为基于麦克纳姆轮的转运平台，每个智能体上均设置有运动轨迹规划及闭环控制模块、位姿测量传感器接口模块、以及位姿测量传感器组合；

位姿测量传感器接口模块采用RS422、网口和RS232用于接收测量传感器组合采集的智能体当前位姿信息，提供给运动轨迹规划及闭环控制模块，运动轨迹规划及闭环控制模块根据外部输入的智能体自身的理论运动参数，结合本智能体当前的位姿信息以及通过无线控制模块获得的其他智能体的位姿信息，进行轨迹规划的闭环补偿，生成实际运动数据。

如图3所示，位姿测量传感器组合包括激光测距传感器、激光二维雷达以及二维光电传感器PSD；激光测距传感器用于测量相邻两个智能体之间的距离，激光二维雷达用于测量相邻两个智能体之间的相对姿态和角度，二维光电传感器PSD用于测量相邻两个智能体之间的姿态偏差。

在整个运动规划过程中，涉及到的运动数据、位姿信息传输都对实时性和同步性有着高需求。多智能体高速同步无线控制模块采用基于WIFI网络拓扑方式架构无线通讯链路,具备多达255个智能体的接入能力，响应频率可达100Hz。同时采用高速的800MHz主频32位处理器进行时间同步算法设计，同步精度可达微秒级。TDMA时隙调度机制事先为无线网络各个节点分配通道资源，且各节点智能在分配的时隙上发送数据，有效保障了通信的实时性、可靠性，特别当时间同步精度要求较高时能更进一步提高实时和可靠性。各单智能体通过WIFI无线链路进行互相通讯。

本发明中，运动轨迹规划及闭环控制模块进行轨迹规划的闭环补偿，生成实际运动参数，具体为：

S1、将多智能体中最前端的智能体作为主智能体，其它作为从智能体；

S2、主智能体按照该智能体理论运动参数进行运动，其它从智能体根据与主智能体的位姿偏差进行运动补偿；

S3、每个从智能体在主智能体的后端面选取一个参考点；并确定每个从智能体与该从智能体所选参考点之间的位姿作为初始位姿；

S4、在多智能体协同转运过程中，每个从智能体实时获取该从智能体与该从智能体所选参考点之间的位姿作为实时位姿；

S5、根据所述初始位姿和实时位姿进行位姿偏差计算，确定每个从智能体与主智能体的位姿偏差；

S6、对每个从智能体，设定位姿调整阈值，然后利用位姿偏差与阈值计算位姿偏差百分比；

S7、选取所有百分比中的最大值，然后进行归一化后，确定每个从智能体的调整幅值；

S8、对每个从智能体，利用调整幅值进行每个方向幅值的耦合重计算；利用耦合重计算结果建立各方向的控制律；然后设定插补间隔，利用耦合重计算结果、控制律确定各方向的插补增量；最后设定控制阈值，利用插补增量确定的生成从智能体补偿运动参数(Δυ_xi，Δυ_yi，Δυ_ωi)；

S9、根据从智能体补偿运动参数和从智能体理论运动参数累加生成从智能体实际运动参数(υ'_xi，υ'_yi，υ'_ωi)：

利用S8中所述的补偿运动参数，确定每个从智能体的各轮转速。

S8中，对每个从智能体，利用调整幅值进行每个方向幅值的耦合重计算时，根据高度方向的调整幅值，对其他方向的位姿调整偏差进行重计算，获得重计算后的各方向调整幅值；

利用重计算后的各方向调整幅值建立各方向的控制律；

利用重计算后的各方向调整幅值建立各方向的控制律时，首先对重计算后的各方向调整幅值进行归一化，然后建立各方向的指数趋近律。

S8中，当插补间隔大于控制阈值时，运动控制量逐渐增大；当插补间隔不超过控制阈值时，运动控制量逐渐减小。

以品型拼接方式为例，运动轨迹规划及闭环控制模块具体计算如下：

(1)如图5所示，品型拼接是以三个智能体之间呈品字形分布并以几何形心O点为整体转运中心进行运动，以最前端的智能体作为主智能体，后两个八智能体为从智能体，三智能体之间的初始相对位姿可随实际需求进行柔性化自适应，即图5中的a、b可随意变化，其中a为前主智能体后端面与后从智能体前端面的距离值，b为后两个从智能体几何中心点之间的距离值。

(2)如图6所示，以从智能体1的中心O₁建立坐标系X₁O₁Y₁，以从智能体2的中心O₂建立坐标系X₂O₂Y₂，以主智能体后端面中心点O₀建立坐标系X₀O₀Y₀，则可知：

从智能体1中心点O₁在主智能体的坐标系X₀O₀Y₀的初始位姿为：

从智能体2中心点O₂在主智能体的坐标系X₀O₀Y₀的初始位姿为：

(3)如图5所示，按照转运对象的实际质量特性选择合适的a、b参数，即形成了多智能体的初始分布设计。根据多智能体协同自主转运系统的物理模型计算从智能体1中心点O₁在主智能体的坐标系X₀O₀Y₀的初始位姿以及从智能体2中心点O₂在主智能体的坐标系X₀O₀Y₀的理论初始位姿；同时在多智能体协同作业过程中通过TCP/IP通信协议以100Hz的通信周期读取激光扫描雷达实时测量从智能体相对主智能体后端面A、B的轮廓数据并拟合出两个端面轮廓中心在激光扫描雷达的距离和角度数据，并求解从智能体1中心点O₁、从智能体2中心点O₂在主智能体的坐标系X₀O₀Y₀的实时位姿。

(4)多智能体协同转运系统在运动过程中，从智能体1的前端面中心点相对于主智能体后端面A、B点的实时测量数据为{(d_A1',θ_A1'),(d_B1',θ_B1')}，则可得从智能体1几何中心点O₁在主智能体的坐标系X₀O₀Y₀的实时位姿(d_x1',d_y1',d_z1')：

从智能体2的前端面中心点相对于主智能体后端面A、B点的实时测量数据为{(d_A2',θ_A2'),(d_B2',θ_B2')}，则可得从智能体2几何中心点O₁在主智能体的坐标系X₀O₀Y₀的实时位姿(d_x2',d_y2',d_z2')：

/>

(5)计算从智能体相对主智能体后端面的实时位姿(d_xi',d_yi',d_zi')与初始设定位姿(d_xi,d_yi,d_zi)的偏差为(Δε_xi,Δε_yi,Δε_zi):

其中，实时根据后两从智能体中心点在主智能体的坐标系X₀O₀Y₀的实时位姿与初始位姿之差联合建立后双智能体协同调整控制策略：首先以同一时刻两智能体的x，y，z三轴位姿偏差记为(Δε₁,Δε₂,Δε₃,Δε₄,Δε₅,Δε₆)，并作为调整控制的输入参数。

按照设定姿态调整阈值(ξ₁,ξ₂,ξ₃,ξ₄,ξ₅,ξ₆)计算两智能体的三轴位姿偏差数据的百分比(ρ₁,ρ₂,ρ₃,ρ₄,ρ₅,ρ₆)，按照百分比大小排序求得最大偏差百分比ρ_max。按照如下步骤进行：

a)以最大偏差百分比ρ_max的轴姿态偏差进行两智能体的各轴调整幅值

Δμ_i计算，可知有：

b)根据两智能体的各轴调整幅值进行耦合重计算：

由z轴姿态调整偏差Δμ_z在调整过程中引起的x、y轴位姿偏差：

各轴位姿调整偏差重计算：

/>

c)根据两智能体耦合重计算后各轴的调整幅值建立各自的控制律：

对各轴调整幅值的归一化处理：

δ(i)＝(Δμ'_i/ξ_i)/max(Δμ'_i/ξ_i)

建立各轴指数趋近律

l(i)＝(e^δ(i)-e^-δ(i))/(e^δ(i)+e^-δ(i))

d)以T_τ为插补间隔，计算各轴的插补增量：

Δσ_i＝Δμ'_iT_τl(i)

e)设当前的各轴给定控制参数为

以当前控制参数的1/10为阈值为依据对各轴姿态调整插补增量Δσ_i设计积分分离PID算法：当插补增量Δσ_i大于阈值时，调整的速度输出量应逐渐增大，且误差小时增长率小，误差大时增长率大；当偏差值小于或等于插补增量Δσ_i时，调整的速度输出量应逐渐减小，即有：

Δυ_i＝K_pi(Δσi-Δσi')+K_ii*Δσi+K_di*(Δσi-2*Δσi'+Δσi”))

故知姿态调整后的运动控制量为:

故可以求出各个轮的转速：

其中，采用MECHATROLINK_II现场运动总线实现主、从智能体多轴驱动电机的拓扑连接。根据主、从智能体所有电机的当前速度V_i实际和目标速度V_i目标进行二十轴的联动插补控制，实现主、从智能体的同步规划控制。

本发明未详细说明部分属本领域技术人员公知常识。

Claims (12)

1.一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于包括：主控制器、指令接收及处理模块、导航单元、组合拼接路径规划模块、无线控制模块以及多个智能体；

指令接收及处理模块接收外部输入的控制指令，该控制指令包括转运系统的运动指令及拼接模式，并将转运系统的运动指令及拼接模式发送给主控制器；主控制器将所述运动指令发送给导航单元，导航单元根据转运系统当前位置的实测值以及接收到的运动指令进行导航解算，生成转运系统总体偏航角、速度以及旋转角速度，并反馈给主控制器；

主控制器将拼接模式以及导航单元反馈的运动参数发送给组合拼接路径规划模块，组合拼接路径规划模块根据拼接模式，将转运系统总体的运动参数分解为各智能体的理论运动参数，并通过无线控制模块发送给对应的各个智能体；各个智能体根据接收到的自身的理论运动参数，结合本智能体当前的位姿信息以及通过无线控制模块获得的其他智能体的位姿信息，进行轨迹规划的闭环补偿，生成实际运动参数，当前智能体按照该实际运动参数进行运转，从而实现多个智能体的协同自主转运；

导航单元包括：导航控制模块、导航传感器接收模块、视觉导航传感器、激光导航传感器以及i GPS导航传感器；

视觉导航传感器采集标识物与视觉导航传感器之间的局部相对位置信息；激光导航传感器和i GPS导航传感器采集传感器自身在全局坐标系下的坐标信息和姿态角；导航传感器接收模块接收三种传感器的输出结果并提供给导航控制模块；

当需要的定位精度在1mm～5mm之间时，导航控制模块对所述局部相对位置信息进行坐标转换，得到整体转运中心在局部坐标系下的相对坐标和姿态角，并根据得到的相对坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度，反馈给主控制器；所述局部坐标系是指以标识物的中心为原点建立的坐标系；

当需要的定位精度大于等于5mm时，导航控制模块对激光导航传感器采集的传感器自身在全局坐标系下的坐标信息和姿态角进行坐标转换，得到整体转运中心在全局坐标系下的坐标和姿态角；并根据得到的坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度，反馈给主控制器；所述全局坐标系是指：以智能体转运场地的顶点为原点建立坐标系；

当需要的定位精度小于等于1mm时，导航控制模块对i GPS导航传感器采集的传感器自身在全局坐标系下的坐标信息和姿态角进行坐标转换，得到整体转运中心在全局坐标系下的坐标和姿态角；并根据得到的坐标、姿态角以及目标路径偏差，生成转运系统总体偏航角、速度以及旋转角速度，反馈给主控制器。

2.根据权利要求1所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：所述指令接收及处理模块接收的外部输入控制指令，来自于手持器发送的手动控制指令或者来自于外部调度系统的自动控制指令。

3.根据权利要求1所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：外部输入控制指令中的转运系统的运动指令，具体包括：目标坐标X、目标坐标Y、目标角度θ、运行指令以及运行模式；

目标坐标X、目标坐标Y和目标角度θ为全局坐标系下的位置，运行指令包括停车、前进、后退、右横行、左横行、逆时针旋转90°以及顺时针旋转90°；运行模式包括紧急停车模式和常规模式；紧急停车模式是指整个转运系统即刻停止运行；常规模式是指转运系统按照指令正常运行的模式。

4.根据权利要求1所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：外部输入控制指令中的转运系统的拼接模式，具体包括：L型拼接、品型拼接、双车拼接以及四车拼接；

L型拼接是指三个智能体按照L形排列的形式；品型拼接是指三个智能体按照品型排列的形式；双车拼接是指两个智能体按照横向或纵向并排的形式排列；四车拼接是指四个智能体按照矩形排列的形式。

5.根据权利要求1所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：所述组合拼接路径规划模块根据拼接模式，将转运系统总体的运动参数分解为各智能体的理论运动参数，具体包括如下步骤：

(1)以整体转运中心O为理论形心，计算各个智能体中心点到整体转运中心O的相对位姿；

(2)当拼接整体以姿态(υ_x,υ_y,ω_z)进行运动时，在坐标系XOY中，计算单位时间Δt内各个智能体中心的位置增量；坐标系XOY是以整体转运中心O为圆心的坐标系；

(3)计算拼接整体转运过程中各智能体的实时理论运动数据。

6.根据权利要求5所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：

首先将多智能体进行编号i＝1,2,……n，当已知拼接模式下第i个智能体中心O_i相对选取整体转运中心点O之间的位姿为

其中

为第i个智能体中心O_i相对整体转运中心点O之间的距离，

为第i个智能体中心O_i相对整体转运中心点O之间的角度；

单位时间Δt内第i个智能体中心的X向、Y向位置增量以及角度增量(Δs_xi,Δs_yi,Δθ_zi)分别为：

则可知拼接整体转运过程中第i个智能体的实时理论运动数据(υ_xi,υ_yi,υ_ωi)为：

7.根据权利要求1所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：所述智能体为基于麦克纳姆轮的转运平台，每个智能体上均设置有运动轨迹规划及闭环控制模块、位姿测量传感器接口模块、以及位姿测量传感器组合；

位姿测量传感器接口模块接收测量传感器组合采集的智能体当前位姿信息，提供给运动轨迹规划及闭环控制模块，运动轨迹规划及闭环控制模块根据外部输入的智能体自身的理论运动参数，结合本智能体当前的位姿信息以及通过无线控制模块获得的其他智能体的位姿信息，进行轨迹规划的闭环补偿，生成实际运动数据。

8.根据权利要求7所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：位姿测量传感器组合包括激光测距传感器、激光二维雷达以及二维光电传感器PSD；激光测距传感器用于测量相邻两个智能体之间的距离，激光二维雷达用于测量相邻两个智能体之间的相对姿态和角度，二维光电传感器PSD用于测量相邻两个智能体之间的姿态偏差。

9.根据权利要求7所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：所述运动轨迹规划及闭环控制模块进行轨迹规划的闭环补偿，生成实际运动参数，具体为：

S1、将多智能体中最前端的智能体作为主智能体，其它作为从智能体；

S2、主智能体按照该智能体理论运动参数进行运动，其它从智能体根据与主智能体的位姿偏差进行运动补偿；

S3、每个从智能体在主智能体的后端面选取一个参考点；并确定每个从智能体与该从智能体所选参考点之间的位姿作为初始位姿；

S4、在多智能体协同转运过程中，每个从智能体实时获取该从智能体与该从智能体所选参考点之间的位姿作为实时位姿；

S5、根据所述初始位姿和实时位姿进行位姿偏差计算，确定每个从智能体与主智能体的位姿偏差；

S6、对每个从智能体，设定位姿调整阈值，然后利用位姿偏差与阈值计算位姿偏差百分比；

S7、选取所有百分比中的最大值，然后进行归一化后，确定每个从智能体的调整幅值；

S8、对每个从智能体，利用调整幅值进行每个方向幅值的耦合重计算；利用耦合重计算结果建立各方向的控制律；然后设定插补间隔，利用耦合重计算结果、控制律确定各方向的插补增量；最后设定控制阈值，利用插补增量确定的生成从智能体补偿运动参数(Δυ_xi，Δυ_yi，Δυ_ωi)；

S9、根据从智能体补偿运动参数和从智能体理论运动参数累加生成从智能体实际运动参数(υ'_xi，υ'_yi，υ'_ωi)：

10.根据权利要求9所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：利用S8中所述的补偿运动参数，确定每个从智能体的各轮转速。

11.根据权利要求9所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：S8中，对每个从智能体，利用调整幅值进行每个方向幅值的耦合重计算时，根据高度方向的调整幅值，对其他方向的位姿调整偏差进行重计算，获得重计算后的各方向调整幅值；

利用重计算后的各方向调整幅值建立各方向的控制律；

利用重计算后的各方向调整幅值建立各方向的控制律时，首先对重计算后的各方向调整幅值进行归一化，然后建立各方向的指数趋近律。

12.根据权利要求9所述的一种面向异构特性大型装备多智能体协同自主转运系统，其特征在于：S8中，当插补间隔大于控制阈值时，运动控制量逐渐增大；当插补间隔不超过控制阈值时，运动控制量逐渐减小。

Images