机器人手臂的机械结构和机电设置

1、【摘 要】机器人学是一门边缘学科，它涉及电子精密机械、空间机构学、操纵 动力学、人机工程学等的一门系统工程。 本人在已有的机器人手臂的机械结构和 机电设计的基础上，基于Motorola公司的DSP56805单片机及PC机设计并实现 了机器人臂部多关节控制系统。设计以MOTORO公司生产DSP56805单片机为核心，设计了机器人臂部关节控制 节点的硬件电路，并在此基础上利用C语言编制了机器人臂部关节的 DSP控制程 序，控制算法中采用了经典的PID控制算法，论文中采用了一种用 Matlab模拟仿真来近似确定PID控制参数(Kp Ki、Kd)的方法。最后进行了系统程序、 硬件仿真调试， 结果表明：

2、系统的软、硬件设计合理可行。 所以机器人设计是符合要求的。关键词：控制节点、PID控制算法、PID控制参数、DSP56805 Matlab、VC 6.0 Title: Robotic Arms Intelligent Control SystemAbstractThe robotics is an edge course, it involves the precise machine, the space organization, manipulated the dynamics, person with machine engineering learns a system engine

3、ering of etc. On given foundation of an electric shock the design at the machine structure and machines of the robotic arms ,I have been up and carried out a many joints of the robotic arms control system also according to a singlechip of DSP56805 and the PC machine designs of the company of Motorol

4、a.The design of thesis 'nuclere isthe Motorola company produces a singlechip of DSP56805, designed a joint of the robot arm to control the hardware telephone of the nodal point, and make use of the DSP control procedure that the C language drew up a joint of the robot arm on this foundation, ado

5、pting the PID control calculate way of the classic in the control calculate way, adopting in the thesis a kind of with the method that the analog simulation of Matlab looks like the certain PID control parameter( Kp, Ki, Kd).Carried on the debugging of the system procedure and the hardware simulatio

6、n finally, the result show:This design about system of the software and the hardware don't only go,but also is reasonable.So therobotic design meets the request.Keywords:Control the nodal point, the PID control calculate way, PID control parameter, DSP56805 、 Matlab 、 VC 6.0目录1绪论11.1项目背景及意义11.2方

7、案论证22机器人的机械结构介绍32.1机器人的一般神经网络结构图32.2机器人的臂部机械结构42.3机器人的臂部关节电机分布图42.4小结53 PID算法介绍及位置控制算法63.1 PID算法简介63.1.1 比例运算放大电路63.1.2积分运算电路73.1.3微分电路73.1.4 PID调节电路73.2电机物理模型83.3实际电机的开环阶跃响应93.4开环系统模拟仿真 173.5闭环比例控制模拟仿真 183.6闭环比例微分控制模拟仿真 203.7闭环比例微分积分控制模拟仿真 223.8 PWM简介 253.9本章小结 254智能机器人手臂设计硬件电路图设计 264.1拟人机器人臂部电机及电机

8、驱动电路 264.2驱动电路的功能介绍说明 274.2.1 MC33035E刷直流电机控制器概述 274.2.2 MC33035無刷直流電机控制器的工作原理 294.2.3 MC33039电子测速器概述 304.2.4 MC33039电子测速器的工作原理 314.2.5三相全波六步无刷直流电动机闭环速度控制电路 314.3臂部节点硬件电路分析 324.4臂部节点硬件资源分配 334.5 臂部节点电路设计 364.5.1电源电路设计 364.5.2滤波电路、时钟电路、复位电路设计 384.5.3 DSP接口电路设计 384.5.4 电机控制接口电路设计 414.6 本章小结 425拟人机器人机器

9、人臂部关节节点软件设计 435.1臂部节点软件功能概述 435.2臂部节点软件流程 435.2.1初始化模块445.2.2主循环模块 455.2.3控制曲线规划模块 465.2.4 PID 模块 485.3臂部节点软件编程 505.3.1 静态配置 505.3.2 IO 端口操作 515.3.3 中断服务程序 525.4本章小结 52致谢 53参考文献 54附录A 55附录B 56附录C 65第一章绪论1.1项目背景及意义机器人是上个世纪中叶迅速发展起来的高新技术密集的机电一体化产品，在发达国家，工业机器人已经得到广泛应用。 随着科学技术的发展，机器人的应用范围 也日益扩大，遍及工业、国防、宇

10、宙空间、海洋开发、医疗健康等领域。浸入 21世纪，人们已经愈来愈亲身感受到机器人深入产业、深入生活、深入社会的 坚实步伐。拟人机器人(HumanoidRobo)更是先进机器人技术的高级发展阶段， 它综合体现了高级机器人的机构学、运动与动力学、现代设计理论、信息检测和 感知、微电子学、控制理论等诸多方面的研究和发展水平，是一个复杂的综合系 统。它涉及多种学科的内容。下图1-1为下载的拟人机器人的雏形。图1-1拟人机器/帚*机器人的核心是控制系统。机器人的先进性和功能的强弱通常都直接与其控制系 统的性能有关。手臂是拟人机器人的重要执行机构，在整个拟人机器人中起着重 要的作用。单独的手臂本身也是一个

11、机器人，如目前应用非常普遍的工业六轴机 器人实质就是一个拟人的手臂。如果不考虑手臂与其他部分的协调问题，本论文 中的控制对象就是一个工业六轴机器人。1.2方案论证机器人系统有许多控制方法。例如PID，模糊控制，自适应控制等。模糊控制和 自适应控制的精度很高。 是现代控制领域中应用广泛的控制方法， 尤其是在军工 领域和航天领域中。 PID 控制是最基本的控制方法。它的控制方法与前两种相比 不高。但在要求不高的情况下大多采用 PID 控制算法。在大多数领域中一般可将 几种控制方法结合使用， 达到性能价格的最优组合。 由于本次设计所做机器人的 要求不高， 并且工作环境也是在正常环境中， 所以本文的设

12、计思路也是采用经典 控制理论中的PID控制。PID控制有很强的实用性。它对系统的调节即可达到快 速敏捷，又可达到平稳准确， 只要三项作用的强度配合适当， 便可得到满意的调 节效果。本设计采用的 PID 控制为转速、电流双闭环调速系统。 大部分的电机控制调速系 统大多采用这种方式。 首先它运行稳定。 外环控制转速， 转速调节的作用时对转 速的抗干扰调节并使之在稳态时无静差， 其输出限幅值决定允许的最大电流； 在 内环控制电流， 电流调节器的作用是电流跟随， 过流自动保护和及时抑制电压第 二章机器人的机械结构分析2.1 机器人的一般神经网络结构图 机器人是一个高度协调的系统， 其完成的每一个动作都

13、是整个系统中所有元素配 合工作的结果。 它的身上有很多电机和传感器， 这些电机和传感器在底层由本文 所设计的控制节点控制着， 但是孤立的节点是没有意义的， 必须要将机器人身上 所有的节点连接起来构成一个控制网络， 使得所有的节点都在机器人的“大脑” 的统一支配下。这样一个网络好比人身体里的神经，将大脑的指令传达给“肌 肉”，同时将感觉到的信息送给大脑。 在这样一个体系下， 每个节点必须实时和 上位机打交道， 获取指令， 上传数据，这样对通讯协议就有了速度和可靠性的要 求，大多数机器人设计选择了 CAN总线作为全身的神经系统。头部.节点0 CAN总线牌部节占小腰部节点总线嘉点O图2-1机器人的一般神经网络结构图存第二章机器人的机械结构分析2.1机器人的一般神经网络结构图机器人是一个高度协调的系统，其完成的每一个动作都是整个系统中所有元素配 合工作的结果。它的身上有很多电机和传感器，这些电机和传感器在底层由本文 所设计的控制节点控制着，但是孤立的节点是没有意义的，必须要将机器人身上 所有的节点连接起来构成一个控制网络，使得所有的节点都在机器人的“大脑” 的统一支配下。这样一个网络好比人身体里的神经