[发明专利]仿生机械恐龙的控制系统

说明书

技术领域

本发明涉及四足机器人，具体涉及仿生机械恐龙的控制系统。

背景技术

机器人技术是近几十年来迅速发展起来的一门高新技术，它综合了机械、微电子与计算机、自动控制、传感器与信息处理以及人工智能等多学科的最新研究成果，是机电一体化技术的典型载体。大型四足仿生机械恐龙是四足步行机器人的一种重要应用，广泛应用于娱乐、影视等领域。

众所周知，机械结构是仿生机械恐龙的骨骼，而控制系统则相当于仿生机械恐龙的神经系统，控制系统是实现仿生机械恐龙“动”的关键，并且关系到运动的能力和运动的效果。目前，机器人的控制系统主要有集中式控制或者基于运动控制卡的分布式控制两种方式。

（1）集中式控制。

该方式主要应用于小型的专用设备，例如遥控小汽车、洗衣机控制系统等。对于四足仿生机械恐龙而言，由于其关节自由度多（12个以上），运动方式不定，关节协调性和实时性要求高，因此，如果采用集中式控制方式，控制器的控制负担将过重，很难满足实时性等要求。

（2）基于运动控制卡。

该方式是使用若干个多轴运动控制卡组成分布式网络，其优点是控制系统搭建周期短，而且运动控制卡所包含的软件包中都集成有丰富的运动函数库，能方便的实现各种预定函数和实现多轴插补。但是该方式应用于四足仿生机械恐龙也存在一定的不足：（a）四足仿生机械恐龙具有多个自由度（12个以上），而运动控制卡的控制轴数有限（一般最多为6轴），所以需要加载多块运动控制卡，并且还需要支持多卡同时通讯的功能，因此，控制软件设计复杂，出错率高；（b）由于一个运动控制卡同时控制多轴，所以需要给每个轴单独配置驱动器，从而造成驱动器配置复杂；（c）系统的扩展性差；（d）系统调试过程复杂。

另外，由于控制系统的调试是保证机器人正常工作的前提，因此，控制系统的调试在控制系统中占有重要的地位，然而现有的机器人控制系统均没有集成调试系统，调试与动作控制分开进行，增加了调试的难度。

有鉴于此，需要对四足仿生机械恐龙的控制系统进行优化设计，一方面简化控制系统的结构，另一方面方便扩展和调试。

发明内容

本发明所要解决的技术问题是解决如何简化仿生机械恐龙的控制系统结构，并方便扩展和调试的问题。

为了解决上述技术问题，本发明所采用的技术方案是提供一种仿生机械恐龙的控制系统，包括发送控制指令的上位机和驱动各关节运动的动作执行器，所述上位机上设有发送控制各关节运动的动作控制模块、显示各关节运动状态的监测模块以及用于调试各动作控制器参数的调试模块；所述动作执行器分别通过动作控制器连接到CAN总线上，所述上位机根据用户指令发出相应的控制信号，所述控制信号通过CAN总线发送给相应的动作控制器使相应的动作执行器驱动相应的关节运动。

在上述方案中，所述调试模块包括关节ID查看及修改单元和关节调试单元，所述关节ID查看及修改单元通过读取存放各关节ID的NodeID文件显示所有关节的ID号，并根据用户对相应关节ID的修改替换所述的NodeID文件；所述用户对相应关节ID的修改依据为相应动作控制器上的拨码位置；所述关节调试单元根据用户输入的若干个关节ID号及其组合和相应的调整参数向特定的关节ID输出关节调整控制信号至所述动作控制模块。

在上述方案中，所述调整参数包括驱动关节运动的速度、加速度、转角，以及关节的使能、相对运动、绝对运动、运动停止和打开抱闸。

在上述方案中，所述监测模块130接收用户指令并根据相应动作执行器中的传感器信号，实时显示各关节的ID号、运动状态和运动参数；所述运动状态是指错误、准备和使能，并分别由不同的颜色表示；所述运动参数为关节的转角。

在上述方案中，所述动作执行器为直流无刷伺服电机。

在上述方案中，所述调试模块还包括用于调整动作控制器的PID参数的PID调整单元。

在上述方案中，无自锁功能的电机上设有抱闸，相应的所述动作控制器上设有抱闸控制电路。

在上述方案中，所述调试模块还包括NodeID搜索模块，通过查找节点功能搜索CAN网络中所有的节点，并根据是否收到回复为依据显示相应的成功与否结果。

本发明，通过CAN总线将上位机和各动作控制器组建成CAN网络，大大简化了控制系统的结构，便于扩展；同时，在上位机上集成了显示各关节运动状态的监测模块以及用于调试各动作控制器参数的调试模块，大大方便了控制系统的调试。

附图说明

图1为本发明提供的仿生机械恐龙的控制系统结构框图；