CN112873188A - 自组装模块化机器人单元、机器人、组装及控制方法 - Google Patents

Abstract

本发明涉及一种自组装模块化机器人单元、机器人、组装及控制方法，通过提供的自组装模块化机器人单元可以自组装，通过感知、控制自主完成与其它机器人与物体的对接，对接后形成的组合体不仅具备整体移动能力还具备关节运动与操作能力，实现从轮式/履带到关节式的复合运动特性。从而可以克服群体机器人之间无连接或者连接弱的特点，实现跨模式的运动，也增加了组合体机器人的结构多样性，如构建成蛇形、多足等机器人形态，组装方式灵活多样，让单个机器人通过组合完成越障、搬运等高于自身能力的任务。

Description

自组装模块化机器人单元、机器人、组装及控制方法

技术领域

本发明涉及模块化机器人技术领域，尤其涉及一种自组装模块化机器人单元、机器人、组装及控制方法。

背景技术

在工业等传统应用领域中，机器人的任务及环境相对固定，多采用构型结构相对固定的移动机器人、关节式机器人，这些机器人在特定工作场景和已知结构信息中可完成特定任务。而在深空探测、灾难救援和家用服务等新兴领域中通常存在多样化、非结构化的任务。例如在星球深空探测、应急救援中，存在表面地形复杂，如高度障碍、楼梯、洞穴等，作业地域广泛，需要完成多种任务，适应不同的工作环境，因此，需要机器人完全自主构建具备强通过能力、多任务适应能力的平台，并在必要时进行结构变换，满足不同需求。以往固定结构机器人受到其单一形态的限制，很难满足多样化和变结构的任务需求。而模块化机器人系统能够利用自组装、自重构等特性在离散或者连接的情况下改变自身构型以适应多种任务，对解决特殊环境下的复杂任务具有重要意义。

模块化机器人主要是通过个体与个体之间、个体与环境之间的局部交互，进行结构重组，产生系统行为，从而具有自重构、自组装等特性。目前，包括(1)晶格式自重构机器人，如MetaMorphic、Catoms、Crystalline、Fraca和M-BLOCK等机器人，模块的自主移动主要依赖组合后模块的运动能力，不具备独立自主移动能力或者连接后不具备关节运动能力；(2)关节式自重构机器人，如PolyBot、CKBot、YaMoR、M-TRAN、Superbot、UBot、Sporiwutz和Roombot等机器人，每个模块一般具有旋转自由度，具有多关节机器人的优势，可形成如机械臂、抓手或者腿等结构，但模块不具备独立自主移动能力；(3)自组装机器人，如S-bot、E-puck和Oung的自组装飞行阵列等，一群模块可通过移动、相互连接，自动从离散状态组装成设定结构。

目前晶格式机器人适用于自重构特性的研究，自重构规划也多数基于此类机器人。关节式机器人适合于执行任务，比如运动行走、抓取物体等，但由于局限的形态扩展能力，在自重构方面较晶格式少，但在任务环境中的应用场景较多。而模块化机器人自组装的维度受到本身自由度的限制，多局限在二维平面内。

因此，为实现关节式结构作业强、群体结构移动强的组合优势，提出具备关节与移动能力的群体移动自组装模块化机器人，离散机器人群体通过局部简单行为组装成系统结构，将自组装与自重构有效结合，使模块化机器人具有目标构形自组装、自重构且具有关节运动和作业的能力，从而通过结构变化提升任务自适应性。

发明内容

针对群体机器人形成的可变结构少、自动对接能力弱以及连接后不具备关节运动能力的问题，本发明提供一种自组装模块化机器人单元、机器人、组装及控制方法,通过局部简单行为组装成系统结构，将自组装与自重构有效结合，使模块化机器人具有目标构形自组装、自重构且具有关节运动和作业的能力，从而通过结构变化提升任务自适应性。

为达到上述目的，本发明提供了一种自组装模块化机器人单元，包括主动对接模块和被动对接模块、定位模块、控制模块以及车架；

所述主动对接模块固定在所述车架上，具有间距可调节的夹持部；所述被动对接模块固定在所述车架上，具有突出部；

所述定位模块确定模块化机器人单元的位置；

两个模块化机器人单元之一作为主动对接方，主动对接方的控制模块获取拟级联的目标模块化机器人单元的位置，移动使主动对接模块的夹持部对准并包络目标模块化机器人单元的被动对接模块的突出部，调整所述夹持部间距，固定目标模块化机器人单元突出部，级联两个机器人单元。

模块化机器人单元通过主动对接模块连接到另一个模块化机器人的尾部被动对接模块或者四周其它位置的被动对接模块，形态不同级联拓扑结构的组合体。

进一步地，所述夹持部内部设置若干对接锥，与所述突出部的对接槽匹配，固定所述突出部。

进一步地，所述夹持部和所述突出部分别设置一组触点，实现级联机器人单元之间的电源及信号传输。

进一步地，所述夹持部包括第一对接板、第二对接板、第一螺母、第二螺母、螺杆、夹持电机、传动组件；

所述第一对接板固定至第一螺母，所述第二对接板固定至第二螺母；所述螺杆包括正反旋向两部分螺纹，第一螺母和第二螺母相反运动；

所述夹持电机通过所述传动组件驱动螺杆转动，使得第一螺母、第二螺母反向旋转带动所述第一对接板和第二对接板沿螺杆彼此靠近或远离。

进一步地，所述夹持部还包括连接架、第一滑块、第一滑轨、第二滑块以及第二滑轨，所述第一滑轨和第二滑轨固定至连接架，长度方向与所述螺杆长度方向平行一致；所述第一滑块与所述第一对接板彼此固定，在所述第一对接板沿所述螺杆移动时，所述第一滑块沿所述第一滑轨移动；

所述第二滑块与所述第二对接板彼此固定，在所述第二对接板沿所述螺杆移动时，所述第二滑块沿所述第二滑轨移动。

进一步地，所述第一滑轨和第二滑轨对称设置在所述连接架凸块的上下表面。

进一步地，所述自组装模块化机器人单元车架的前端设置主动对接模块，后端设置被动对接模块，和/或车架的左端和右端设置被动对接模块。进一步地，还包括移动模块，为左右两个平行的履带及驱动轮毂、张紧轮，或者前面2个麦克纳姆轮、后面两个普通轮及驱动轮毂，差分驱动后面两个轮，或者四个普通轮或者麦克纳姆轮的轮毂独立驱动。

进一步地，所述定位模块包括远距离定位单元、中距离图像定位单元以及近距离红外定位单元；

所述远距离定位单元发送无线电信号获取目标模块化机器人单元的位置，所述控制模块通过无线通信接收目标机模块化器人单元的位置；

所述控制模块通过中距离图像定位单元获取目标模块化机器人单元的位置和姿态；

所述控制模块通过近距离红外定位单元进行主动对接模块和被动对接模块的对准确认。

进一步地，所述近距离红外定位单元包括设置在主动对接模块或被动对接模块中一者的红外发射部件和设置在另一者的红外接收部件。

进一步地，所述中距离图像定位单元包括设置在主动对接模块或被动对接模块中一者的摄像头模块，设置在另一者的视觉标记，以及里程计；通过摄像头模块和机器人驱动轮毂的编码器或者姿态里程计融合后，测量定位信息，融合方法包括利用摄像头识别视觉标记获得的绝对位姿与机器人编码器/姿态里程计获得的相对位姿进行滤波；所述视觉标记表征机器人单元的编号，以及能够被图像识别的三个不共线的特征点。

进一步地，所述远距离定位单元包括无线通信系统和无线定位系统；无线定位系统用于定位自身位置，采用超宽带定位UWB方法，在应用场地外安装3个以上的参考基站，来确定各个机器人相对基站的位置；所述无线通信系统用于发送表征自身编号、位置的无线信号，接收表征其它机器人单元的编号、位置的无线信号。

进一步地，还包括关节驱动模块，驱动所述主动对接模块执行俯仰和偏航动作。

进一步地，所述主动对接模块铰接固定至机器人单元车架；关节驱动模块包括平行对称设置的第一驱动组件和第二驱动组件，分别连接在夹持部的两侧和机器人单元车架之间；通过改变所述第一驱动组件和所述第二驱动组件轴向长度差，调整所述主动对接模块的偏航角度；通过所述第一驱动组件和所述第二驱动组件的长度调整，调整所述主动对接模块的俯仰角度。

进一步地，调整偏航、俯仰角度在机器人底座不平时，使得对接前两个机器人单元的主动对接模块和被动对接模块的对接锥与对接槽轴线重合。

进一步地，所述第一驱动组件和所述第二驱动组件结构相同，包括第一球铰、直线电机、第二球铰；所述直线电机通过第一球铰连接至固定支架，通过固定支架固定至机器人单元车架，所述直线电机的输出轴通过第二球铰固定至夹持部的一侧，直线电机包括固定端和推杆输出轴，实现推杆输出轴轴向伸缩。

另一方面提供一种自组装模块化机器人，包括若干所述的自组装模块化机器人单元，自组装模块化机器人单元车架的前端设置主动对接模块，后端设置被动对接模块，和/或者车架的左端和右端设置若干被动对接模块；

自组装模块化机器人单元前后顺序连接，形成蛇形机器人；

或者由所述的自组装模块化机器人单元对接系统对接组成若干多足机器人；自组装模块化机器人包括若干横向级联的自组装模块化机器人单元和若干纵向级联的自组装模块化机器人单元；横向级联时，自组装模块化机器人单元的左端和右端的被动对接模块级联若干纵向级联的自组装模块化机器人单元的前端的主动对接模块，纵向级联时，自组装模块化机器人单元通过后端的被动对接模块与其它纵向自组装模块化机器人单元主动对接模块纵向级联。

进一步地，每个横向、纵向级联的自组装模块化机器人单元在后端、或者左右两侧能够依次扩展纵向及横向级联的自组装模块化机器人单元。

进一步地，通过控制机器人单元的关节驱动模块执行俯仰和偏航执行关节动作；通过控制机器人单元移动模块执行移动动作。

第三方面提供一种所述的自组装模块化机器人的自组装方法，包括：

在主动对接机器人单元与目标机器人单元之间规划一条轨迹，轨迹包括两段，第一段轨迹起始点为主动对接机器人单元的当前位姿，终点与目标机器人单元的被动对接模块偏航方向对齐，第一段轨迹为多项式曲线或者样条曲线，第二段轨迹以第一段轨迹终点为起始点，终点为目标机器人单元正后方一定距离，使得主动对接模块与被动对接模块能够执行夹持操作；

驱动夹持部打开，控制主动对接模块所在机器人单元移动使得所述夹持部包络突出部，驱动夹持部固定突出部，级联两个机器人单元。

进一步地，其特征在于，主动对接机器人单元与目标机器人单元之间的定位包括：由所述远距离定位单元引导机器人单元移动至目标机器人后部可视距离内，识别目标机器人单元的编号与位置姿态，规划第一段、第二段轨迹，由中距离图像定位单元沿第一段轨迹引导至主动对接模块和被动对接模块偏航方向对齐，并沿第二段轨迹引导至对接位置使夹持部到达被动对接模块部位，由红外定位单元确认已经对准，控制进行对接。

进一步地，级联的自组装模块化机器人单元选择一个控制模块作为主控制器，其它控制模块作为从控制器接收主控制器的指令，向主控制器反馈自身的位姿、速度信息，驱动各个自组装模块化机器人单元通过履带移动，或者执行关节驱动实现移动。

进一步地，对于蛇形机器人执行关节驱动进行仿蛇蜿蜒或仿尺蠖/毛毛虫蠕动或者同时驱动移动模块移动；当遇到障碍时，驱动关节模块执行俯仰运动，抬起前方的自组装模块化机器人单元高于障碍，驱动移动模块移动通过障碍后，通过执行俯仰运动，回落至地面；或驱动关节模块执行偏航运动，越障过程中转向；

对于多足机器人执行关节驱动执行关节驱动仿足移动；当遇到障碍时，驱动关节模块执行俯仰、偏航，抬起、摆动前方的自组装模块化机器人单元高于障碍，通过障碍后，通过执行俯仰、偏航，回落至地面。

进一步地，当需要执行对目标物的操作时，驱动各个关节模块执行俯仰和/或偏航到达目标姿态，对目标进行包裹抓取。

本发明的上述技术方案具有如下有益的技术效果：

(1)本发明提供的自组装模块化机器人单元可以自组装，通过感知、控制自主完成与其它机器人与物体的对接，对接后形成的组合体不仅具备整体移动能力还具备关节运动与操作能力，实现从轮式/履带到关节式的复合运动特性。从而可以克服群体机器人之间无连接或者连接弱的特点。

(2)本发明实现跨模式的运动，增加了组合体机器人的结构多样性，如构建成蛇形、多足等机器人形态，组装方式灵活多样，让单个机器人通过组合完成越障、搬运等高于自身能力的任务。

(3)本发明自组装模块化机器人单元通过多种定位方法实现对自身的定位，在远距离时(距离目标0.5-1米以上)利用超宽带定位技术结合固定的基站实现0.1-1米精度的粗定位，在近距离(距离目标0.1-0.5米)时，利用摄像头结合姿态里程计信息测量目标标记实现0.05-0.2米精度的细定位；在贴近目标(距离目标0-0.1米)时，利用红外传感器实现0.005-0.02米的精细定位。通过三种定位手段相互结合，实现机器人从较远距离开始自主对接，使得自动对接成功率明显提高，扩展了的机器人的自动对接移动范围。

(4)本发明的夹持部通过电机驱动开合，设置上下两个滑块进行承载力分解，利用夹持的方法提高对接的成功率，保证了机器人的稳定性和连接强度。

(5)本发明的主动对接单元能够进行俯仰和偏航的控制，使得组装后的机器人能够执行关节运动；对于多足等机器人通过俯仰和偏航的控制实现足类移动；对接过程可动态调整主被动对接模块，提高地形适应性。

附图说明

图1是群体移动自组装模块化机器人单元结构示意图；

图2是主动对接模块左前和左后视图以及滑块组成图；其中图2(a)为左前视图，图2(b)为左后视图，图2(c)为滑块组成图，图2(d)为安装滑轨后示意图，图2(e)为安装滑轨后另一角度视图；

图3为主动对接模块示意图，其中图3(a)为主动对接模块爆炸视图，图3(b)为主动对接模块夹持传动示意图，图3(c)为主动对接模块侧向视图；

图4为被动对接模块图及对接锥/槽对应图；其中，图4(a)为被动对接模块示意图；图4(b)为对接锥/槽对应图；

图5为关节驱动模块图；其中图5(a)为偏航、俯仰复合动作侧向视图，

图5(b)为偏航动作俯视图，图5(c)为俯仰动作示意图；

图6为移动模块、车架与感知驱动控制系统组成图；

图7为轮子移动模块组成图，其中图7(a)为四轮驱动移动模块图，图7(b)为两轮差速驱动移动模块图，图7(c)为麦克纳姆轮全向移动模块图；

图8为移动模块化机器人单元利用传感器自主对接框架图；

图9为移动模块化机器人单元组成蛇形机器人；

图10为移动模块化机器人单元组成四足机器人；

图11为移动模块化机器人单元组成八足机器人；

图12为蛇形机器人控制越障示意图；

图13为蛇形机器人控制爬楼梯示意图。

具体实施方式

为使本发明的目的、技术方案和优点更加清楚明了，下面结合具体实施方式并参照附图，对本发明进一步详细说明。应该理解，这些描述只是示例性的，而并非要限制本发明的范围。此外，在以下说明中，省略了对公知结构和技术的描述，以避免不必要地混淆本发明的概念。

本发明的目的在于提供一种自组装模块化机器人单元及其形成的群体移动自组装模块化机器人，以解决现有技术中存在的群体机器人形成的可变结构少、自动对接能力弱以及连接后不具备关节运动能力等问题。

自组装模块化机器人由一组模块化机器人单元组成，每个模块化机器人单元具备移动能力，任意两个移动模块化机器人可以通过自主移动利用对接系统形成级联的组合体，组合体之间可以通过关节进行运动，也可以共同移动。

自组装模块化机器人单元通过前后首尾相连接，可以形成具备移动能力和关节运动能力的蛇形机器人。一组模块化机器人单元连接到另一组模块化机器人单元的左右两侧或者尾部，可以形成仿生多足关节机器人。

自组装模块化机器人单元利用摄像头、红外传感器自主感知测量其它的机器人(目标)的编号，并且确定目标的位置和姿态。各个群体移动自组装模块化机器人单元相互之间以及与外部的通信基站可以组成无线网络，一组机器人单元形成一个子网，具备一个协调器，另一组机器人单元形成另一个子网，具备一个协调器，各个协调器形成另一个网络，典型通信协议为ZigBee。

自组装模块化机器人单元具有不同精度和距离的定位系统，实现远、中、近距离的目标定位。在远距离时(距离目标0.5-1米以上)利用超宽带定位技术结合固定的基站实现0.1-1米精度的粗定位，在近距离(距离目标0.1-0.5米)时，利用摄像头结合姿态里程计信息测量目标标记实现0.05-0.2米精度的细定位；在贴近目标(距离目标0-0.1米)时，利用红外传感器实现0.005-0.02米的精细定位。

自组装模块化机器人单元包括主动对接模块1以及被动对接模块2。自组装模块化机器人单元还包括关节驱动模块3、移动模块4、定位模块5及车架6。主动对接模块1位于车架6的前方，被动对接模块2位于车架6的后方或者左右两侧，关节驱动模块3的输出端连接到主动对接模块1，固定端连接到车架6。移动模块4位于车架6的左右两侧。

主动对接模块1，包括连接架11、第一滑块组12、第一对接板13、第二滑块组14、第二对接板15、对接锥16、电机固定架17、电机18、第一传动组件19、第二传动组件20、第三传动组件21、螺杆22、第一螺母23和第二螺母24、摄像头模块25、连接轴26和红外接收面板27，如图2和图3所示。连接架11具有左右两侧的连杆，连杆上部的端点有两个连接孔111，下部有两个连接孔112，连接轴26连接到连接孔111上。第一滑块组12的滑块121沿滑轨122滑动，滑轨122固定在连接架11的凸块114上面。第二滑块组14的滑块141沿滑轨142滑动，滑轨142固定在连接架11的凸块114下面。第一对接板13连接到滑块121上，第二对接板15连接到滑块141上。对接锥16安装在第一对接板13和第二对接板15上，每个对接板至少包括1个对接锥16，一个主动对接模块至少包括3个对接锥16，典型为左右镜面对称分布各2个对接锥16。电机18输出轴驱动第一传动组件19，第一传动组件19、第二传动组件20、第二传动组件21啮合形成传动组件，结合图3(c)，其旋转支撑轴固定到连接架11的传动固定架113上。第三传动组件21和螺杆22同步传动，螺杆22通过轴承安装在传动固定架113上。电机18通过电机固定架12连接到支架11上，电机18输出轴直接与第一传动组件19同轴相连并且驱动旋转，依次传动第二传动组件20、第二传动组件21，最终驱动螺杆22转动，螺杆的左右螺纹为相反旋向，从而驱动螺母23和24向相反方向沿螺杆22直线运动，螺杆22的左右螺纹为相反旋向。螺母23和24分别与第一对接板13和第二对接板15连接，第一对接板13和第二对接板15分别连接到第一滑块组12的滑块121和第二滑块组14的滑块141，限制了螺母23和24的旋转，并由上下两个滑块组共同提供对接后级联机器人之间力的传递与支撑。在仅可平行左右直线移动的约束下，第一对接板13和第二对接板15分别向相反方向沿螺杆22直线运动。安装到螺杆上的螺母23和24的旋向相反，保证在螺杆22驱动下反方向运动。通过该对接模块，连接板可对称打开和闭环，从而可与被动对接模块配合完成两个机器人之间的刚性连接。螺杆螺母机构实现开合，传动具有自锁能力。第一滑块组12和第二滑块组14可提高对接机构的连接刚度和强度。电机18通过伺服闭环控制，可控制连接板打开和闭环的大小。传动固定架113左右两部分的距离h为开合最小距离，螺杆22、导轨122和142中最小距离为开合最大距离，该距离范围为允许对接的结构误差。对接锥16为圆锥形状，与被动对接机构模块2的对接槽结构配合，如果对接锥16已经插入对接槽28，但在主被动对接模块与被动对接模块没有完全对准时，锥角可让两个机器人在电机18驱动力的引导下使两个对接模块完成对接。摄像头模块25连接到连接架11上，镜头向前，可以感知识别视觉标记28和其它物体，内部集成专用图像处理电路。红外接收面板27连接到连接架11上，上面分布有水平一线布局的红外接收管。

被动对接模块2包括对接槽28、视觉标记29和红外发射管30，如图4所示。对接槽28和对接锥16在数量、布局上相同。视觉标记29具有编码功能，代表该移动模块化机器人的编号，典型的编码方式为二维码或者色块，可以通过摄像头模块25识别后测量出其相对位置和姿态。红外发射管30发射一束红外光，主动对接模块1上的红外接收面板27上分布的某个红外接收管接收该红外光，表示发射接收对齐，主动对接模块1与被动对接模块2对齐。

主动对接模块1和被动对接模块2各设置有一组触点131和211，当对接机构闭合时，触点接通，可实现对接两模块机器人之间的动力电源及通讯信号的连通，以便模块间有线通讯。

关节驱动模块3包括支撑架31、第一球铰32、第一直线电机33、第二直线电机34、第二球铰35、偏航固定板36、俯仰固定板37、偏航连接轴38、俯仰连接轴39组成，如图5a。支撑架31固定到车架6上。第一直线电机33、第二直线电机34分别通过第一球铰32连接到支撑架31上，连接点的偏航和俯仰自由度不被约束固定，可被动运动。第一直线电机33、第二直线电机34通过第二球铰35连接到连接架11的连接轴26上，连接点的偏航和俯仰自由度不被约束固定，可被动运动。主动对接模块1的连接架11通过俯仰连接轴39与俯仰固定板37相连，可相对进行被动的俯仰运动，俯仰固定板37相连通过偏航连接轴38与偏航固定板36相连，可相对进行被动的偏航运动，偏航固定板36连接到车架6上。当第一直线电机33与第二直线电机34中一个伸长同时另一个缩短相同距离时，主动对接机构1相对车架6偏航一定角度a,如图5b。第一直线电机33、第二直线电机34可分别控制长度，当同时伸长或者缩短相同距离时，主动对接机构1相对车架6俯仰一定角度b，如图5c。分别控制第一直线电机33、第二直线电机34的长度，实现主动对接机构1相对车架6偏航、俯仰一定角度。平衡状态下，主动对接机构1相对车架6偏航、俯仰角度为0，偏航固定板36与偏航连接轴38相交点距离直线电机中轴的距离为l，两个直线电机的距离为d，第一球铰32和第一球铰35之间的水平距离为l。第一直线电机33、第二直线电机34的行程以及l、c和d影响偏航角度a、俯仰角度b的范围以及主动电机驱动对接机构的传动比。利用直线电机推杆的方式可以提高关节的驱动力矩，从而提升多个模块化机器人连接在一起时的运动性能。

调整偏航、俯仰角度也可在机器人底座不平时，使得对接前两个机器人单元的主动对接模块和被动对接模块的对接锥与对接槽轴线重合，如图4(b)所示。

移动模块4具备地面移动能力，由一组履带移动模块或者轮子驱动模块组成，如图6所示。履带驱动模块包括左右两个平行的履带；或者轮子驱动模块，包括前后各两个轮子的四驱、两轮差分驱动或者四个轮子为麦克纳姆轮的驱动移动方式。

履带移动模块4包括第一驱动轮毂41、第二驱动轮毂42、第三驱动轮毂43、第四驱动轮毂44、第一驱动电机45、第二驱动电机46、张紧轮47、第一履带48、第二履带49。驱动轮毂左右各两个为一组，前后布局连接到车架，驱动一条履带。张紧轮连接在车架，通过偏离压紧履带，并跟随履带自动旋转。至少两个驱动电机，一个驱动左侧的一个驱动轮毂，另一个驱动右侧的一个驱动轮毂，为减小移动模块化机器人横向尺寸，两个驱动电机前后布局，分别驱动前面和后面的各一个驱动轮毂。履带为环状，外表面局部凹凸的槽增加摩擦力，内部通过钢丝纤维环增强耐疲劳程度。一个实例，第一驱动轮毂41、第二驱动轮毂42前后布局，分布在车架6的右侧，支撑驱动第一履带48。同样，第三驱动轮毂43、第四驱动轮毂44前后布局，分布在车架6的左侧，支撑驱动第二履带49。右侧张紧轮47的固定端连接到车架6上，通过调整位置形成对第一履带48的张紧力。左侧类似。第一驱动电机45驱动第一驱动轮毂41，第二驱动电机46驱动第三驱动轮毂43。驱动电机集成减速器、马达、编码器以及驱动控制器，通过位置及速度闭环精确控制左右两侧履带的旋转速度。驱动轮毂分别安装在车架6左右两侧的轮毂安装轴611上。

轮子驱动模块，前后各两个轮子的四驱形式为前后左右布置一个驱动电机，分别驱动四个驱动轮毂运动，每个驱动轮毂外装轮胎，如图7a。两轮差分驱动形式为后面两个驱动电机驱动两个后面的轮子，而前面两个轮子为被动轮，同样，也可以前面两个驱动电机驱动两个前面的轮子，而后面两个轮子为被动轮，如图7b。麦克纳姆轮的驱动移动方式为前后左右布置一个驱动电机，分别驱动四个驱动轮毂运动，每个驱动轮毂外装轮胎，可以形成平面完整运动的系统，如图7c。

定位模块5系统包括无线通信系统52、远距离定位单元53(无线定位系统)、中距离图像定位单元、近距离红外定位单元等。中距离图像定位单元包括摄像头模块25和姿态感知模块54，近距离红外定位单元包括红外接收面板27和红外发生管30。无线通信系统52采用Zigee、Lora或者NBIoT等物联网协议，除机器人自身的无线通信系统外，在其它地方可以安装通信的协调器和路由器，各个机器人通过该通信系统以及其它的协调器、路由器组成网状拓扑的通信网络；无线定位系统53采用超宽带定位UWB方法，在应用场地外安装3个以上的参考基站，来确定各个机器人相对基站的位置；姿态感知模块54采用陀螺仪、加速度计和磁强计通过滤波器形成的惯性传感系统，控制模块，包括控制器，还可以包括图像传输模块，将摄像头数据无线传输到外部接收点，还包括温湿度等传感器来增加模块化机器人的功能。控制模块的主控制器51与无线通信系统52、无线定位系统53、姿态感知模块54进行串行通信，与轮毂电机、对接电机与关节驱动模块的控制系统进行通信，与主动对接模块的电机的驱动器进行通信控制，与摄像头模块进行通信，获取识别的编号和目标位姿信息等。机器人单元由锂电池55供电。

自组装模块化机器人单元通过多种定位方法实现对主动对接模块化机器人单元相对被动对接的移动模块化机器人单元的定位，首先接收到无线通信信号，采用ZigBee、Lora、NBIoT等无线信号，在较远距离获得被动对接的移动模块化机器人(目标)的编号以及粗略位置(0.1-0.5米精度误差)，该粗略位置为各个机器人内部无线定位系统测量出自身相对基站的位置；主动对接机器人运动到目标对接机器人后部较近距离，通过摄像头模块25寻找到被动对接模块2上的视觉标记29，识别编号和初步的位置姿态作为目标，首先通过摄像头模块和自身姿态里程计融合后获得估计的定位信息，融合方法包括利用摄像头识别视觉标记获得的绝对位姿与机器人编码器/姿态里程计获得的相对位姿进行滤波(卡尔曼滤波器、贝叶斯估计、蒙特卡洛法或者粒子滤波器)，主动对接移动模块化机器人通过移动模块3运动到被动对接移动模块化机器人纵轴中心线上(第一阶段)，实现两个机器人在水平面朝向的偏航角度对齐，然后主动对接移动模块化机器人在摄像头模块和自身姿态的引导下沿直线运动到被动对接移动模块化机器人的被动对接模块2处，完成主动对接模块1与被动对接模块2的对齐，对接锥16与对接槽28配合，完成两个移动模块化机器人的连接，如图8所示。

车架6包括左右对称的第一车体61、第二车体62和底板63，三者刚性连接。被动对接模块3连接到第一车体61和第二车体62的尾部固定或者连接到左右两侧。关节驱动模块3连接到第一车体61和第二车体62的上部固定。关节驱动模块3的偏航固定板36连接到第一车体61和第二车体62的前部固定。

被动对接模块2位于车架6尾部时，移动模块化机器人通过主动对接模块1与被动对接模块2的连接，前后首尾相连接，形成具备移动能力和关节运动能力的蛇形机器人，如图9所示。

被动对接模块3位于车架6尾部以及车体61和62左右两侧时，移动模块化机器人通过主动对接模块1与被动对接模块2的连接，一组移动模块化机器人连接到另一组移动模块化机器人的左右两侧，可以形成仿生四足关节机器人，如图10所示，或者八足关节机器人，如图11所示，或者其它仿生多足机器人。

本发明提供一种所述的自组装模块化机器人的自组装方法，包括规划、定位与控制。规划部分为在主动对接机器人单元与目标机器人单元之间规划一条轨迹，两段组成，第一段轨迹起始点为主动对接机器人单元的当前位姿，终点为使得主动对接模块和被动对接模块偏航方向对齐，此轨迹可为多项式曲线或者样条曲线，多项式曲线采用

其中ai为第i项的系数，n为多项式的阶数。第二端轨迹以第一段轨迹终点为起始点，终点为目标机器人单元正后方一定距离，使得主动对接模块与被动对接模块可完成夹持，如图8所示。定位部分由所述远距离定位单元引导机器人单元移动至目标机器人后部可视距离内，由中距离图像定位单元引导至主动对接模块和被动对接模块偏航方向对齐，进一步引导至到达对接位置使加持部到达被动对接模块部位，由红外定位单元确认已经对准，控制进行对接。控制部分，待级联的两个机器人单元彼此定位，移动至主动对接模块和被动对接模块相对位置，驱动夹持部打开，控制被动对接模块所在机器人单元移动使得突出部插入所述夹持部，驱动夹持部固定突出部，级联两个机器人单元。

自组装模块化机器人控制方法，包括：在模块化机器人单元级联后形成的整体的自组装模块化机器人控制时，选用其中一个模块化机器人单元作为主控制器，负责算法、任务及系统处理，利用无线通信系统或者级联对接时的有线总线(RS485、CAN等)来与其它级联的模块化机器人单元通信，控制各个模块化机器人单元执行移动动作、关节动作，并采集传感器等信息。

自组装模块化机器人在运动过程中既可以利用移动动作前行，实现整体前进/后退、转向；也可以结合关节运动前行，通过关节运动抬实现越障和翻越。执行关节动作可以控制级联的部分模块化机器人单元作为移动的腿，也可以控制级联的部分模块化机器人单元作为操作物体、抓取物体的臂、或者手，以及作为颈部定位摄像头等模块。级联形成蛇形机器人时，若干模块化机器人分布于平面运动区，与外部基站进行无线通信(ZigBee)。根据指令自动组装形成蛇形机器人。蛇形机器人通过履带行走，或者执行关节驱动进行仿蛇蜿蜒、仿尺蠖/毛毛虫蠕动。如若遇到障碍，利用俯仰关节以此抬起前方模块化机器人单元高于障碍，然后前行移动，使得位于障碍上方的模块化机器人单元与障碍上面接触，同时执行移动动作，越过障碍后，利用俯仰关节落下前方模块化机器人单元到地面，执行移动动作，依次通过障碍，如图12所示。蛇形机器人通过移动动作和关节动作组合越过楼梯，通过楼梯的方法为，当模块化机器人单元头部接触到楼梯时，第1个俯仰关节抬起，使得前部机身与楼梯斜面平行，再继续移动前行时，第2个和第1个俯仰关节配合，使前部机身与楼梯斜面平行，依次类推，直到整个机器人穿过楼梯，在楼梯对此，反序依次控制，如图13所示。

级联形成多组机器人，使得与地面接触的模块化机器人单元执行移动动作，在地面移动，在遇到障碍时，执行关节动作可以抬起各个纵向级联的模块化机器人单元，翻越爬行。

综上所述，本发明涉及一种自组装模块化机器人单元、机器人、组装及控制方法，通过提供的自组装模块化机器人单元可以自组装，通过感知、控制自主完成与其它机器人与物体的对接，对接后形成的组合体不仅具备整体移动能力还具备关节运动与操作能力，实现从轮式/履带到关节式的复合运动特性。从而可以克服群体机器人之间无连接或者连接弱的特点，实现跨模式的运动，也增加了组合体机器人的结构多样性，如构建成蛇形、多足等机器人形态，组装方式灵活多样，让单个机器人通过组合完成越障、搬运等高于自身能力的任务。

应当理解的是，本发明的上述具体实施方式仅仅用于示例性说明或解释本发明的原理，而不构成对本发明的限制。因此，在不偏离本发明的精神和范围的情况下所做的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。此外，本发明所附权利要求旨在涵盖落入所附权利要求范围和边界、或者这种范围和边界的等同形式内的全部变化和修改例。

Claims (12)

1.一种自组装模块化机器人单元，其特征在于，包括主动对接模块和被动对接模块、定位模块、控制模块以及车架；

所述主动对接模块固定在所述车架上，具有间距可调节的夹持部；所述被动对接模块固定在所述车架上，具有突出部；

所述定位模块确定模块化机器人单元的位置；

两个模块化机器人单元之一作为主动对接方，主动对接方的控制模块获取拟级联的目标模块化机器人单元的位置，移动使主动对接模块的夹持部对准并包络目标模块化机器人单元的被动对接模块的突出部，调整所述夹持部间距，固定目标模块化机器人单元突出部，级联两个机器人单元。

模块化机器人单元通过主动对接模块连接到另一个模块化机器人的尾部被动对接模块或者四周其它位置的被动对接模块，形态不同级联拓扑结构的组合体。

2.根据权利要求1所述的自组装模块化机器人单元，其特征在于，所述夹持部内部设置若干对接锥，与所述突出部的对接槽匹配，固定所述突出部。进一步地，所述夹持部和所述突出部分别设置一组触点，实现级联机器人单元之间的电源及信号传输。

3.根据权利要求2所述的自组装模块化机器人单元，其特征在于，所述夹持部包括第一对接板、第二对接板、第一螺母、第二螺母、螺杆、夹持电机、传动组件；

所述第一对接板固定至第一螺母，所述第二对接板固定至第二螺母；所述螺杆包括正反旋向两部分螺纹，第一螺母和第二螺母相反运动；

所述夹持电机通过所述传动组件驱动螺杆转动，使得第一螺母、第二螺母反向旋转带动所述第一对接板和第二对接板沿螺杆彼此靠近或远离。

4.根据权利要求3所述的自组装模块化机器人单元，其特征在于，所述夹持部还包括连接架、第一滑块、第一滑轨、第二滑块以及第二滑轨，所述第一滑轨和第二滑轨固定至连接架，长度方向与所述螺杆长度方向平行一致；所述第一滑块与所述第一对接板彼此固定，在所述第一对接板沿所述螺杆移动时，所述第一滑块沿所述第一滑轨移动；

所述第二滑块与所述第二对接板彼此固定，在所述第二对接板沿所述螺杆移动时，所述第二滑块沿所述第二滑轨移动。

进一步地，所述第一滑轨和第二滑轨对称设置在所述连接架凸块的上下表面。

5.根据权利要求1至4之一所述的自组装模块化机器人单元，其特征在于，所述自组装模块化机器人单元车架的前端设置主动对接模块，后端设置被动对接模块，和/或车架的左端和右端设置被动对接模块。进一步地，还包括移动模块，为左右两个平行的履带及驱动轮毂、张紧轮，或者前面2个麦克纳姆轮、后面两个普通轮及驱动轮毂，差分驱动后面两个轮，或者四个普通轮或者麦克纳姆轮的轮毂独立驱动。

6.根据权利要求1至4之一所述的自组装模块化机器人单元，其特征在于，所述定位模块包括远距离定位单元、中距离图像定位单元以及近距离红外定位单元；

所述远距离定位单元发送无线电信号获取目标模块化机器人单元的位置，所述控制模块通过无线通信接收目标机模块化器人单元的位置；

所述控制模块通过中距离图像定位单元获取目标模块化机器人单元的位置和姿态；

所述控制模块通过近距离红外定位单元进行主动对接模块和被动对接模块的对准确认。

进一步地，所述近距离红外定位单元包括设置在主动对接模块或被动对接模块中一者的红外发射部件和设置在另一者的红外接收部件。

进一步地，所述中距离图像定位单元包括设置在主动对接模块或被动对接模块中一者的摄像头模块，设置在另一者的视觉标记，以及里程计；通过摄像头模块和机器人驱动轮毂的编码器或者姿态里程计融合后，测量定位信息，融合方法包括利用摄像头识别视觉标记获得的绝对位姿与机器人编码器/姿态里程计获得的相对位姿进行滤波；所述视觉标记表征机器人单元的编号，以及能够被图像识别的三个不共线的特征点。

进一步地，所述远距离定位单元包括无线通信系统和无线定位系统；无线定位系统用于定位自身位置，采用超宽带定位UWB方法，在应用场地外安装3个以上的参考基站，来确定各个机器人相对基站的位置；所述无线通信系统用于发送表征自身编号、位置的无线信号，接收表征其它机器人单元的编号、位置的无线信号。

7.根据权利要求1-6之一所述的自组装模块化机器人单元，其特征在于，还包括关节驱动模块，驱动所述主动对接模块执行俯仰和偏航动作。

进一步地，所述主动对接模块铰接固定至机器人单元车架；关节驱动模块包括平行对称设置的第一驱动组件和第二驱动组件，分别连接在夹持部的两侧和机器人单元车架之间；通过改变所述第一驱动组件和所述第二驱动组件轴向长度差，调整所述主动对接模块的偏航角度；通过所述第一驱动组件和所述第二驱动组件的长度调整，调整所述主动对接模块的俯仰角度。

进一步，调整偏航、俯仰角度在机器人底座不平时，使得对接前两个机器人单元的主动对接模块和被动对接模块的对接锥与对接槽轴线重合。

进一步，所述第一驱动组件和所述第二驱动组件结构相同，包括第一球铰、直线电机、第二球铰；所述直线电机通过第一球铰连接至固定支架，通过固定支架固定至机器人单元车架，所述直线电机的输出轴通过第二球铰固定至夹持部的一侧，直线电机包括固定端和推杆输出轴，实现推杆输出轴轴向伸缩。

8.一种自组装模块化机器人，其特征在于，包括若干权利要求1至8之一所述的自组装模块化机器人单元，自组装模块化机器人单元车架的前端设置主动对接模块，后端设置被动对接模块，和/或者车架的左端和右端设置若干被动对接模块；

自组装模块化机器人单元前后顺序连接，形成蛇形机器人；

或者由所述的自组装模块化机器人单元对接系统对接组成若干多足机器人；自组装模块化机器人包括若干横向级联的自组装模块化机器人单元和若干纵向级联的自组装模块化机器人单元；横向级联时，自组装模块化机器人单元的左端和右端的被动对接模块级联若干纵向级联的自组装模块化机器人单元的前端的主动对接模块，纵向级联时，自组装模块化机器人单元通过后端的被动对接模块与其它纵向自组装模块化机器人单元主动对接模块纵向级联。

进一步，每个横向、纵向级联的自组装模块化机器人单元在后端、或者左右两侧能够依次扩展纵向及横向级联的自组装模块化机器人单元；

进一步，通过控制机器人单元的关节驱动模块执行俯仰和偏航执行关节动作；通过控制机器人单元移动模块执行移动动作。

9.一种权利要求8所述的自组装模块化机器人自组装的方法，其特征在于，包括：

在主动对接机器人单元与目标机器人单元之间规划一条轨迹，轨迹包括两段，第一段轨迹起始点为主动对接机器人单元的当前位姿，终点与目标机器人单元的被动对接模块偏航方向对齐，第一段轨迹为多项式曲线或者样条曲线，第二段轨迹以第一段轨迹终点为起始点，终点为目标机器人单元正后方一定距离，使得主动对接模块与被动对接模块能够执行夹持操作；

驱动夹持部打开，控制主动对接模块所在机器人单元移动使得所述夹持部包络突出部，驱动夹持部固定突出部，级联两个机器人单元。

10.根据权利要求9所述的自组装模块化机器人的自组装方法，其特征在于，主动对接机器人单元与目标机器人单元之间的定位包括：由所述远距离定位单元引导机器人单元移动至目标机器人后部可视距离内，识别目标机器人单元的编号与位置姿态，规划第一段、第二段轨迹，由中距离图像定位单元沿第一段轨迹引导至主动对接模块和被动对接模块偏航方向对齐，并沿第二段轨迹引导至对接位置使夹持部到达被动对接模块部位，由红外定位单元确认已经对准，控制进行对接。

11.一种权利要求9至10之一所述的自组装模块化机器人的控制方法，其特征在于，级联的自组装模块化机器人单元选择一个控制模块作为主控制器，其它控制模块作为从控制器接收主控制器的指令，向主控制器反馈自身的位姿、速度信息，驱动各个自组装模块化机器人单元通过履带移动，或者执行关节驱动实现移动。

12.根据权利要求11所述的控制方法，其特征在于，对于蛇形机器人执行关节驱动进行仿蛇蜿蜒或仿尺蠖/毛毛虫蠕动或者同时驱动移动模块移动；当遇到障碍时，驱动关节模块执行俯仰运动，抬起前方的自组装模块化机器人单元高于障碍，驱动移动模块移动通过障碍后，通过执行俯仰运动，回落至地面；或驱动关节模块执行偏航运动，越障过程中转向；

对于多足机器人执行关节驱动执行关节驱动仿足移动；当遇到障碍时，驱动关节模块执行俯仰、偏航，抬起、摆动前方的自组装模块化机器人单元高于障碍，通过障碍后，通过执行俯仰、偏航，回落至地面。

进一步，当需要执行对目标物的操作时，驱动各个关节模块执行俯仰和/或偏航到达目标姿态，对目标进行包裹抓取。

Images