|
|
小型轮移组合臂机器人
摘 要
机器人学是一门边缘学科，它涉及电子精密机械、空间机构学、操纵动力学、人机工程学等的一门系统工程。本人在已有的机器人手臂的机械结构和机电设计的基础上，基于Motorola 公司的PLC及PC机设计并实现了机器人臂部多关节控制系统。
设计以MOTOROLA公司生产PLC为核心，设计了机器人臂部关节控制节点的硬件电路，并在此基础上利用C语言编制了机器人臂部关节的PLC控制程序，控制算法中采用了经典的PID控制算法，论文中采用了一种用Matlab模拟仿真来近似确定PID控制参数（Kp、Ki、Kd）的方法。
最后进行了系统程序、硬件仿真调试，结果表明：系统的软、硬件设计合理可行。所以机器人设计是符合要求的。
关键词：
控制节点、PID控制算法、PID控制参数、PLC、Matlab、VC 6.0
Title: Robotic Arms Intelligent Control System
Abstract
The robotics is an edge course, it involves the precise machine, the space organization, manipulated the dynamics, person with machine engineering learns a system engineering 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 PLC and the PC machine designs of the company of Motorola.
The design of thesis’nuclere isthe Motorola company produces a singlechip of PLC, designed a joint of the robot arm to control the hardware telephone of the nodal point, and make use of the PLC control procedure that the C language drew up a joint of the robot arm on this foundation, adopting 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 simulation finally, the result show:This design about system of the software and the hardware don’t only go,but also is reasonable.So the robotic design meets the request.
Keywords:
Control the nodal point, the PID control calculate way, PID control parameter, PLC、Matlab、VC 6.0
目 录
1绪论 ………………………………………………………………1
1.1项目背景及意义…………………………………………………………………1
1.2 方案论证…………………………………………………………………………2
2 机器人的机械结构介绍…………………………………………3
2.1机器人的一般神经网络结构图…………………………………………………3
2.2机器人的臂部机械结构…………………………………………………………4
2.3机器人的臂部关节电机分布图…………………………………………………4
2.4 小结………………………………………………………………………………5
3 PID算法介绍及位置控制算法…………………………………6
3.1 PID算法简介……………………………………………………………………6
3.1.1比例运算放大电路……………………………………………………………6
3.1.2积分运算电路…………………………………………………………………7
3.1.3微分电路………………………………………………………………………7
3.1.4 PID调节电路…………………………………………………………………7
3.2电机物理模型……………………………………………………………………8
3.3实际电机的开环阶跃响应………………………………………………………9
3.4开环系统模拟仿真 ……………………………………………………………17
3.5闭环比例控制模拟仿真 ………………………………………………………18
3.6闭环比例微分控制模拟仿真 …………………………………………………20
3.7闭环比例微分积分控制模拟仿真 ……………………………………………22
3.8 PWM简介…………………………………………………………………………25
3.9本章小结 ………………………………………………………………………25
4小型轮移组合臂机器人硬件电路图设计…………………………26
4.1拟人机器人臂部电机及电机驱动电路 ………………………………………26
4.2驱动电路的功能介绍说明 ……………………………………………………27
4.2.1 MC33035无刷直流电机控制器概述…………………………………………27
4.2.2 MC33035無刷直流電机控制器的工作原理…………………………………29
4.2.3 MC33039电子测速器概述……………………………………………………30
4.2.4 MC33039电子测速器的工作原理……………………………………………31
4.2.5 三相全波六步无刷直流电动机闭环速度控制电路 ………………………31
4.3臂部节点硬件电路分析 ………………………………………………………32
4.4 臂部节点硬件资源分配 ………………………………………………………33
4.5臂部节点电路设计 ……………………………………………………………36
4.5.1电源电路设计 ………………………………………………………………36
4.5.2滤波电路、时钟电路、复位电路设计 ………………………………………38
4.5.3 PLC接口电路设计……………………………………………………………38
4.5.4 电机控制接口电路设计 ……………………………………………………41
4.6 本章小结 ………………………………………………………………………42
5拟人机器人机器人臂部关节节点软件设计 ………………43
5.1 臂部节点软件功能概述 ………………………………………………………43
5.2 臂部节点软件流程 ……………………………………………………………43
5.2.1初始化模块 …………………………………………………………………44
5.2.2主循环模块 …………………………………………………………………45
5.2.3控制曲线规划模块 …………………………………………………………46
5.2.4 PID模块………………………………………………………………………48
5.3 臂部节点软件编程 ……………………………………………………………50
5.3.1 静态配置 ……………………………………………………………………50
5.3.2 IO端口操作…………………………………………………………………51
5.3.3 中断服务程序 ………………………………………………………………52
5.4本章小结 ………………………………………………………………………52
致 谢 ……………………………………………………………………………53
参考文献…………………………………………………………………………54
附录A………………………………………………………………55
附录B………………………………………………………………56
附录C………………………………………………………………65
