一种机器人控制系统技术方案

本实用新型专利技术公开了一种机器人控制系统，包括双核处理器，双核处理器包括ARM处理器和DSP处理器，本实用新型专利技术采用ARM+DSP控制策略，取代传统方式中工业计算机PC+运动控制卡+伺服驱动器+伺服电机控制方式，ARM负责机器人的运动规划以及轨迹规划，DSP处理器则负责机器人的动力学以及运动学运算，充分利用了DSP强大的运算能力以及ARM的外围控制能力，这样的功能分配能有效的降低主控芯片的开销，将更多的资源用于控制系统安全性和精确的控制，性价比可大幅度提高，本实用新型专利技术具备EtherNet和脉冲模拟量控制方式可供用户选择，可适应多种控制方式的伺服驱动器及伺服电机，方便用户实时切换控制方法，通用性比较强。

A robot control system

The utility model discloses a robot control system, including a dual core processor, dual core processor includes the ARM processor and DSP processor, the utility model adopts the ARM+DSP control strategy, replace the card + servo driver + servo motor control mode of industrial PC+ motion control in the traditional way, ARM is responsible for robot motion planning and trajectory planning, DSP processor responsible for the robot dynamics and kinematics calculation, make full use of the powerful computing capability of DSP and ARM in the peripheral control ability, function allocation that can effectively reduce the main control chip will cost more resources for safety control system and precise control, the price can be greatly improved, the utility model has the advantages of EtherNet and analog pulse control mode for the user to choose, can adapt to a variety of control mode and servo driver Servo motor, which is convenient for real-time switching control, is more versatile.

【技术实现步骤摘要】
一种机器人控制系统
本技术涉及嵌入式计算机控制
，具体涉及一种机器人控制系统。
技术介绍
西安电子科技大学开发的六自由度专用运动控制器硬件平台采用ARM+FPGA架构，一方面采用总线方式实现对多个电机的控制，具体的底层驱动由智能设备完成，能够对设备状态、故障等进行实时检测；另一方面，外部传感器的采样功能由辅助功能芯片FPGA来完成，而作为主控芯片的ARM微控制器则只是在需要的时候通过外部接口获取需要的数据。但是现有技术存在如下缺点：1)、采用ARM作为机器人动力学运算单元，使得系统做大规模复杂运算时候效率低下；2)、控制方式单一，仅支持总线通讯或者单一脉冲模拟量控制方式，不够灵活。
技术实现思路
有鉴于此，为了解决现有技术中的上述问题，本技术提出一种机器人控制系统，能有效的降低主控芯片的开销，并且控制方式比较自由灵活，可适应多种控制方式的伺服驱动器及伺服电机。本技术通过以下技术手段解决上述问题：一种机器人控制系统，包括双核处理器，双核处理器分别与网络通讯模块、数据存储模块、监控模块、网络通讯伺服驱动器、脉冲发生模块、DAC数模转换模块连接；网络通讯模块与上位机连接；脉冲发生模块与脉冲指令伺服驱动器连接；DAC数模转换模块与模拟量指令伺服驱动器连接；网络通讯伺服驱动器与伺服电机连接；伺服电机还分别与脉冲指令伺服驱动器、模拟量指令伺服驱动器、机器人、编码器连接；还包括电源管理模块；所述电源管理模块用于给控制系统提供电源；所述双核处理器包括第一处理器、第二处理器；第一处理器与第二处理器之间进行数据通讯；所述第一处理器用于负责机器人的运动规划、轨迹规划和外围控制；所述第二处理器用于负责机器人的动力学及运动学运算和闭环控制；所述上位机用于用户操作选择控制系统的控制方式，控制方式包括网络通讯控制方式、脉冲指令控制方式、模拟量指令控制方式；所述网络通讯模块用于实现上位机与控制系统子节点的高效通讯；所述数据存储模块用于存储各种数据；所述监控模块用于检测控制系统的温度、电压以及电流；所述网络通讯伺服驱动器用于根据接收的网络信号驱动伺服电机；所述脉冲发生模块用于根据接收的脉冲发生指令发出相应的脉冲指令；所述脉冲指令驱动器用于根据接收的脉冲指令驱动伺服电机；所述DAC数模转换模块用于将接收的数字指令转变模拟量指令；所述模拟量指令伺服驱动器用于根据接收的模拟量指令驱动伺服电机；所述伺服电机用于驱动机器人做出相应的机械动作；所述编码器用于采集伺服电机上的运行参数实时反馈到双核处理器，实现闭环运算。进一步地，所述第一处理器为ARM处理器，第二处理器为DSP处理器。进一步地，所述网络通讯模块通过以太网实现上位机与控制系统子节点的高效通讯，所述网络通讯伺服驱动器根据接收的以太网信号驱动伺服电机。进一步地，所述机器人控制系统还包括与双核处理器连接的串口模块，所述串口模块用于采用串行通信方式的扩展接口实现控制系统与外部设备相连接。进一步地，所述机器人控制系统还包括与双核处理器连接的显示模块，所述显示模块用于显示反映控制系统的状态数据。进一步地，所述机器人控制系统还包括与双核处理器连接的扩展IO模块，所述扩展IO模块用于控制系统与外部设备进行数据分析或交换。进一步地，所述电源管理模块向网络通讯模块供电低压5V，向控制系统其他模块供电低压3.3V。与现有技术相比，本技术的有益效果如下：1)、本技术采用ARM作为外围控制及检测，DSP完成系统动力学运算，充分利用了各自的优势，精简了控制系统，同时性价比大幅度提高；2)、本技术采用EhtherNet可实现高速数据交换及组网；3)、本技术具备EtherNet和脉冲模拟量控制方式以供选择，控制方式比较自由灵活，可适应多种控制方式的伺服驱动器及伺服电机。附图说明为了更清楚地说明本技术实施例中的技术方案，下面将对实施例描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本技术的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。图1是本技术机器人控制系统实施例1的结构示意图；图2是本技术机器人控制系统实施例2的结构示意图。具体实施方式为使本技术的上述目的、特征和优点能够更加明显易懂，下面将结合附图和具体的实施例对本技术的技术方案进行详细说明。需要指出的是，所描述的实施例仅仅是本技术一部分实施例，而不是全部的实施例，基于本技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本技术保护的范围。实施例1如图1所示，本技术提供一种机器人控制系统，包括双核处理器，双核处理器分别与网络通讯模块、数据存储模块、监控模块、网络通讯伺服驱动器、脉冲发生模块、DAC数模转换模块连接；网络通讯模块与上位机连接；脉冲发生模块与脉冲指令伺服驱动器连接；DAC数模转换模块与模拟量指令伺服驱动器连接；网络通讯伺服驱动器与伺服电机连接；伺服电机还分别与脉冲指令伺服驱动器、模拟量指令伺服驱动器、机器人、编码器连接；还包括电源管理模块。所述电源管理模块用于给控制系统提供电源，电源管理模块为低压电源，电源管理模块向网络通讯模块供电低压5V，向控制系统其他模块供电低压3.3V。所述双核处理器采用F28M36P63C2，双核处理器包括第一处理器、第二处理器；第一处理器与第二处理器之间通过IPC进行数据通讯；第一处理器为ARM处理器，第二处理器为DSP处理器，ARM处理器用于负责机器人的运动规划、轨迹规划和外围控制，DSP处理器用于负责机器人的动力学及运动学运算和闭环控制。所述上位机用于用户操作选择控制系统的控制方式，控制方式包括网络通讯控制方式、脉冲指令控制方式、模拟量指令控制方式，方便用户实时切换控制方式，控制方式比较灵活，可采用多种控制方式的伺服驱动器及伺服电机，通用性比较强。所述网络通讯伺服驱动器用于根据接收的网络信号驱动伺服电机；所述脉冲发生模块用于根据接收的脉冲发生指令发出相应的脉冲指令；所述脉冲指令驱动器用于根据接收的脉冲指令驱动伺服电机；所述DAC数模转换模块用于将接收的数字指令转变模拟量指令；电路采用DAC8871芯片实现±10V模拟量电压的产生；所述模拟量指令伺服驱动器用于根据接收的模拟量指令驱动伺服电机；根据控制方式选择可适用于多种控制方式的伺服驱动器及伺服电机，当采用网络通讯方式时，网络通讯电路单元有效，当采用脉冲指令控制方式时，脉冲发生电路单元有效，当采用模拟量控制方式时，DAC电路使能有效。所述伺服电机用于驱动机器人做出相应的机械动作。所述网络通讯模块用于实现上位机与控制系统子节点的高效通讯，采用EtherNET总线方式，实现上位机与机器人控制系统子节点高效通讯或者控制系统与伺服系统的通讯，EtherNet通讯端口电路采用LAN8710和H1102网口变压器实现。所述监控模块用于检测控制系统的温度、电压以及电流。所述数据存储模块用于存储各种数据，包括监控模块检测的各种参数。所述编码器用于采集伺服电机上的运行参数实时反馈到双核处理器，实现闭环运算。安装在机器人伺服电机上的正交编码器实时将伺服电机上的运行参数反馈到控制系统，实现闭环本文档来自技高网...

【技术保护点】
一种机器人控制系统，其特征在于，包括双核处理器，双核处理器分别与网络通讯模块、数据存储模块、监控模块、网络通讯伺服驱动器、脉冲发生模块、DAC数模转换模块连接；网络通讯模块与上位机连接；脉冲发生模块与脉冲指令伺服驱动器连接；DAC数模转换模块与模拟量指令伺服驱动器连接；网络通讯伺服驱动器与伺服电机连接；伺服电机还分别与脉冲指令伺服驱动器、模拟量指令伺服驱动器、机器人、编码器连接；还包括电源管理模块；所述电源管理模块用于给控制系统提供电源；所述双核处理器包括第一处理器、第二处理器；第一处理器与第二处理器之间进行数据通讯；所述第一处理器用于负责机器人的运动规划、轨迹规划和外围控制；所述第二处理器用于负责机器人的动力学及运动学运算和闭环控制；所述上位机用于用户操作选择控制系统的控制方式，控制方式包括网络通讯控制方式、脉冲指令控制方式、模拟量指令控制方式；所述网络通讯模块用于实现上位机与控制系统子节点的高效通讯；所述数据存储模块用于存储各种数据；所述监控模块用于检测控制系统的温度、电压以及电流；所述网络通讯伺服驱动器用于根据接收的网络信号驱动伺服电机；所述脉冲发生模块用于根据接收的脉冲发生指令发出相应的脉冲指令；脉冲指令驱动器用于根据接收的脉冲指令驱动伺服电机；所述DAC数模转换模块用于将接收的数字指令转变模拟量指令；所述模拟量指令伺服驱动器用于根据接收的模拟量指令驱动伺服电机；所述伺服电机用于驱动机器人做出相应的机械动作；所述编码器用于采集伺服电机上的运行参数实时反馈到双核处理器，实现闭环运算。...

【技术特征摘要】
1.一种机器人控制系统，其特征在于，包括双核处理器，双核处理器分别与网络通讯模块、数据存储模块、监控模块、网络通讯伺服驱动器、脉冲发生模块、DAC数模转换模块连接；网络通讯模块与上位机连接；脉冲发生模块与脉冲指令伺服驱动器连接；DAC数模转换模块与模拟量指令伺服驱动器连接；网络通讯伺服驱动器与伺服电机连接；伺服电机还分别与脉冲指令伺服驱动器、模拟量指令伺服驱动器、机器人、编码器连接；还包括电源管理模块；所述电源管理模块用于给控制系统提供电源；所述双核处理器包括第一处理器、第二处理器；第一处理器与第二处理器之间进行数据通讯；所述第一处理器用于负责机器人的运动规划、轨迹规划和外围控制；所述第二处理器用于负责机器人的动力学及运动学运算和闭环控制；所述上位机用于用户操作选择控制系统的控制方式，控制方式包括网络通讯控制方式、脉冲指令控制方式、模拟量指令控制方式；所述网络通讯模块用于实现上位机与控制系统子节点的高效通讯；所述数据存储模块用于存储各种数据；所述监控模块用于检测控制系统的温度、电压以及电流；所述网络通讯伺服驱动器用于根据接收的网络信号驱动伺服电机；所述脉冲发生模块用于根据接收的脉冲发生指令发出相应的脉冲指令；脉冲指令驱动器用于根据接收的脉冲指令驱动伺服电机；所述DAC数模转换模块用于将接收的...

【专利技术属性】
技术研发人员：林宁，王卫军，张弓，顾星，侯至承，蔡君义，祁玫丹，
申请(专利权)人：广州中国科学院先进技术研究所，深圳市中科德睿智能科技有限公司，
类型：新型
国别省市：广东,44