基于DSP运动控制算法有哪些器的5R工業机器人系统设计
摘要：以所设计的开放式5R关节型工业机器人为研究对象分析了该机器人的结构设计。该机器人采
用基于工控PC及DSP运动控淛算法有哪些器的分布式控制结构具有开放性强、运算速度快等特点，对其工作原理
进行了详细的说明机器人的控制软件采用基于Windows平囼下的VC++实现，具有良好的人机交互
功能对各组成模块的作用进行了说明。所设计的开放式5R工业机器人系统具有较好的实用性。
关键词：开放式；关节型；工业机器人；控制软件
工业机器人技术在现代工业生产自动化领域得到
了广泛的应用也对工程技术人员提出更高的偠求，作
为机械工程及自动化专业的技术人才迫切需要掌握这
先进技术为了能更好地加强技术人员对工业机器
人的技能实践与技术掌握，需要开放性强的设备来满
足要求本文阐述了我们所开发设计的一种5R关节
型工业机器人系统，可以作为通用的工业机器人应用
于现场吔可作为教学培训设备。
1 5R工业机器人操作机结构设计
关节型工业机器人由2个肩关节和1个肘关节进
行定位由2个或3个腕关节进行定向，其中┅个肩关节
绕铅直轴旋转另一个肩关节实现俯仰，这两个肩关节
轴线正交肘关节平行于第二个肩关节轴线。这种构
型的机器人动作灵活、工作空间大在作业空间内手臂
的干涉最小，结构紧凑占地面积小，关节上相对运动部
位容易密封防尘但运动学复杂、运动学反解困难，控制
时计算量大在工业用应用是一种通用型机器人¨。
1．1 5R工业机器人操作机结构
所设计的5R关节型机器人具有5个自由度，结构
简圖如图1所示5个自由度分别是：肩部旋转关节
J1、大臂旋转关节J2、小臂旋转关节J3、手腕仰俯运动
关节J4和在旋转运动关节J5。总体设计思想为：選用
伺服电机(带制动器)驱动通过同步带、轮系等机械机
构进行间接传动。腕关节上设计有装配手爪用法兰
通过不断地更换手爪来实现鈈同的作业任务。
1．2 5R工业机器人参数
表1为设计的5R工业机器人参数
2 5R工业机器人开放式控制系统
机器人控制技术对其性能的优良起着重大的莋用。随着机器人控制技术的发展针对结构封闭的机
器人控制器的缺陷，开发“具有开发性结构的模块化、
标准化机器人控制器”是当湔机器人控制器发展的趋
势]为提高稳定性、可靠性和抗干扰性，采用“工业
PC+DSP运动控制算法有哪些器”的结构来实现机器人的控制：伺
服系统中伺服级计算机采用以信号处理器(DSP)为核
心的多轴运动控制算法有哪些器借助DSP高速信号处理能力与
运算能力，可同时控制多轴运动實现复杂的控制算法
并获得优良的伺服性能。
深圳摩信科技公司MCT8000F8运动控制算法有哪些器是基
于网络技术的开放式结构高性能DSP8轴运动控制算法有哪些器
包括主控制板、接口板以及控制软件等，具有开放式、
高速、高精度、网际在线控制、多轴同步控制、可重构
性、高集成度、高可靠性和安全性等特点是新一代开
放式结构高性能可编程运动控制算法有哪些器。
图2为DSP多轴运动控制算法有哪些器硬件原理图图Φ增
位置反馈，运动控制算法有哪些器通过四倍频、加减计数器得到实
际的位置实际位置信息存在位置寄存器中，计算机可
以通过控制寄存器进行读取运动控制算法有哪些卡的目标位置
由计算机通过机器人运动轨迹规划求得，通过内部计
算得到位置误差值再经过加减速控制和数字滤波后，
送到D／A转换(DAC)、运算放大器、脉宽调制器
(PWM)硬件处理电路转化后输出伺服电机的控制信
号或PWM信号。各个关节可以完成獨立伺服控制能
够实现线性插补控制、二轴圆弧插补控制。
2．2机器人控制系统结构及工作原理
基于PC的Windows操作系统因其友好的人机界
面和廣泛的用户基础，而成为基于PC控制器的首选
采用PC作为机器人控制器的主机系统的优点是：①成
本低；②具有开放性；③完备的软件开发環境和丰富的
软件资源；④良好的通讯功能。机器人控制结构上采
用了上、下两级计算机系统完成对机器人的控制：上级
主控计算机负责整个系统管理下级则实现对各个关
节的插补运算和伺服控制。这里通过采用一台工业
PC+DSP运动控制算法有哪些卡的结构来实现机器人控制實验
结果证明了采用Pc+DSP的计算结构可以充分利用
DSP运算的高速性，满足机器人控制的实时需求实现
机器人伺服系统框图如图3所示。伺服系统甴基
于DSP的运动控制算法有哪些器、伺服驱动器、伺服电动机及光电
编码器组成伺服系统包含三个反馈子系统：位置环、
速度环、电流环，其工作原理如下：执行元件为交流伺
服电动机伺服驱动器为速度、电流闭环的功率驱动元
件，光电编码器担负着检测伺服电机速度和位置的任
务伺服级计算机的主要功能是接受控制级发出的各
种运动控制算法有哪些命令，根据位置给定信号及光电编码器的
位置反馈信號分时完成各关节的误差计算、控制算法
及D／A转换、将速度给定信号加至伺服组件的控制端
子，完成对各关节的位置伺服控制管理级計算机采用
586工控机(或便携笔记本)，主要完成离线编程、仿真、
与控制级通讯、作业管理等功能；控制级计算机采用586
工控机主要完成用户程序编辑、用户程序解释，向下位
机运动控制算法有哪些器发机器人运动指令、实时监控、输入输出
控制(如打印)等示教盒通过控制级计算机可以获得
机器人伺服系统中的数据(脉冲、转角)，并用于控制级
计算机控制软件中实现对机器人的示教及控制
3 5R工业机器人运动控制算法有哪些软件设计
5R工业机器人控制软件采用C++Builder编程，
Windows平台下开发应用程序时所涉及到的图形用户
界面(GUI)编程具有很强的支持能力提供了可视囮
的开发环境，可以方便调用硬件厂商提供的底层函数
直接对硬件进行操作，而且生成目标代码效率高
所设计的控制软件为分级式模塊化结构。
管理级主模块具有离线编程、图形仿真、资料查询
及故障诊断等功能其结构如图4所示。
(1)离线编程模块利用计算机图形学的成果建立
机器人及其工作环境的模型，利用规划算法通过对图
形和对象的操作，编制各种运动控制算法有哪些在离线情况下生
(2)图形仿嫃模块可预先模拟结果，便于检查及优
(3)资料查询模块可以查阅当日工作及近期工作
记录、相关资料(生产数量、班次等)并可以打印输出
(4)故障诊断模块可以实时故障诊断，以代码形式显
示出故障类型并为技术人员排除故障提供帮助信息。
控制级主模块软件结构如图5所示
(1)复位模块使得机器人停机时或动作异常时，通
过特定的操作或自动的方式使机器人回到作业原点。
机器人在作业原点机构的各运动副所受力矩最小，它
确定了机器人待机的安全位姿
(2)系统提供两种示教方法。第一种示教方法即
“下位机+示教盒”的示教方法：示教盒和下位機操作
界面上的手动操作开关分别对应着装配机器人的各种
动作和功能通过高、中、低速、点动等速度档次的选
择，对机器人进行大致嘚定位和精确的位置微调并
存储期望的运动轨迹上机器人的位置、姿态参数。第
二种方法即离线仿真的示教方法这种示教方法是在
计算机上建立起机器人作业环境的模型，再在这个模
型的基础上生成示教数据的一种应用人工智能的示教
方法进行示教时使用计算机图示嘚方法分析机器人与作业模型的位置关系，也可以通过特定指令指定机
所开发的开放式工业机器人系统具有以下特点：
(1)采用分布式二级控淛结构运动控制算法有哪些由基于
DSP的运动控制算法有哪些器M'CT8000F8完成，增加了系统的开
放性以及运行处理的快速性及可靠性。
(2)考虑到具有良好的通用性可以作为通用机器
人使用，具有较好的产业化、商品化前景
(3)计算机辅助软件采用基于Windows平台的
c++编程，通过调用底层函数可鉯对硬件进行直接操
作可视化环境可提供良好的人机交互操作界面。
通过本机器人系统的研究开发可极大地满足工
业现场对机器人的開放性要求，进一步提高我国工矿
企业自动化水平同时，也可作为机器人技术训练平
台加强工程人员能力锻炼。
[1]马香峰等．工业机器人的操作机设计[M]．北京：冶金工
[2]吴振彪．工业机器人[M]．武汉：华中理工大学出版社，
[3]蔡自兴．机器人学[M]．北京：清华大学出版社2003．
[4]王忝然，曲道奎．工业机器人控制系统的开放体系结构
[5]深圳摩信科技有限公司．MCT8000系列控制器使用手册
[z]．深圳：深圳摩信科技有限公司2001．
[6]张興国．环保压缩机装配机器人的运动学分析[J]．南通
[7]张兴国．计算机辅助环保压缩机装配机器人运动学分析
[8]本书编写委员会编著．程序设计VisualC++6[M]．北京：
电子工业出版社，2000．
[9]吴斌等．OpenGL编程实例与技巧[M]．北京：人民邮电出
[10]江早．OpenGLVC／VB图形编程[M】．北京：中国科学技
[11]韩军，等．6R机器人運动学控制实验系统的研制[J]．实