机械臂本科生毕业设计论文设计范文.docx

机械臂本科生毕业设计论文设计范文.docx

《机械臂本科生毕业设计论文设计范文.docx》由会员分享，可在线阅读，更多相关《机械臂本科生毕业设计论文设计范文.docx（65页珍藏版）》请在冰点文库上搜索。

机械臂本科生毕业设计论文设计范文

基于STM32的机械臂驱动系统设计

摘要

由于机械臂在各行各业中得到了愈来愈广泛的应用，机械臂控制的多样化、复杂化的需要也随之日趋增多。

作为当今科技领域研究的一个热点，提高机械臂的控制精度、稳定性、操作灵活性对于提高其应用水平有着十分重要的意义。

本课题主要对四自由度机械臂控制系统进展了研究与设计。

作为运动控制系统的一种，该控制系统主要面向底层，力争开发出一套稳定性高，可靠性强并且定位准确的工业机械臂系统。

首先根据机械臂系统的控制要求，整体上设计出单CPU的系统控制方案，即通过控制主控制器输出的PWM波的占空比实现对舵机转动的控制，进而实现各个关节的位置控制。

在硬件方面，主要论述了如何以ARM微处理器STM32F103ZET6、MG995舵机、MG945舵机、超声波传感器和电源模块为主要器件，通过搭建硬件平台和设计软件控制程序构建关节运动控制系统。

然后按照结构化设计的思想，依次对以上各局部的原理和设计方法进展了分析和探讨，给出了实际的原理图和电路图。

在软件设计方面，按照模块化的设计思想将控制程序分为初始化模块和运行模块，并分别对各个模块的程序进展设计。

实验明确，该机械臂控制系统不仅具有很好的控制精度，还具有很好的稳定性、准确性，而且在很大程度上改善了定位精度。

关键词：

四自由度机械臂，STM32，Cortex-M3，脉冲宽度调制

theDesignofManipulatorDriveSystemBasedonSTM32

Author：

XXX

Tutor：

XXX

Abstract

Inrecentyears,robotarmiswidelyusedinindustrycontrol,specialrobot,medicaldeviceandhomeservicerobots.Researchofrobotarmcontrolsystemisafocusinrobotarea.Itismeaningfultoincreasetheperformanceinaccuracy,stabilityandfeasibility.

Thispaperistheresearchanddesignaboutacontrolsystembasedonafourdegreesfreedom’sdesign.And,westrivetodevelopahighstability,reliabilityandaccuratecontrolsystem.

Firstly,accordingtothecontrolrequirementsoftheroboticsystem,theoveralldesignofthesystemcontrolprogramisbasedonasingleCPU.TurnthesteeringcontroltoachievethecontrolofthedutycycleofthePWMwaveoutputbythemaincontroller,soastorealizethepositioncontrolofeachjoint.Intermsofhardware,thepapermainlydiscusseshowtousetheARMmicroprocessorSTM32F103ZET6,MG995Servo,MG945servos,ultrasonicsensorsandpowersupplymoduleasthemainponents,buildajointmotioncontrolsystembybuildinghardwareplatformsandsoftwarecontrolprogram.Thenfollowthestructureddesignideas,principlesanddesignmethodssequentiallyovereachpartisanalyzedanddiscussed,andthengivetheactualschematicorcircuitdiagram.Insoftwaredesign,thecontrolprogramisdividedintotherunmodulesandtheinitializationmoduleanddesignprogramofeachmoduleseparately.

Controlsystemexperimentsshowthatthesystemcansignificantlyimprovetheprecisionofcontrol,andimprovesystemstability,accuracy,sothatthepositioningaccuracyoftherobotarmhasbeengreatlyimprovedandenhanced.

KeyWords:

FourDegreesFreedomRobot,STM32,Cortex-M3,PulseWidthModulation

1绪论

机械臂概述

早在几千年前，人类就开始了机器人的制造，以解决人类繁重的劳动。

例如，古希腊诗人荷马在其长篇叙事诗《伊利亚特》中，描述了“火和锻冶之神〞赫菲斯托斯用黄金锻造出一个侍女[1]。

一直以来，人们也一直致力于将这些美丽的神话变为现实。

1958年世界上的第一台机器人被发明以来，与工业机器人相关的技术得到了迅猛的开展，并且己经愈来愈广泛的应用在机械、电子、汽车等行业[2]。

如今，机器人技术已成为衡量一个国家科技水平的标志之一[3]。

作为近几十年来开展起来的一种自动设备，机械臂可以通过编写软件程序来完成目标任务，它不仅具有人和机器各自的很多优点，而且特别具有人的智能性和适应性。

在作业过程中，机械臂控制的准确性和对环境的适应性，已经使其在各个领域有着广阔的开展前景。

高级类型的机械臂，可以执行更复杂的操作[4]。

将机器臂运用于工业生产过程，除了可以提高生产率之外，还能够减弱工人的劳动强度，使生产过程实现自动控制。

因此机械臂在近几年得到了愈来愈广泛的应用[5]。

机器人的研究始于二战后的美国。

1958年第一台数控工业机器人诞生后，机器人在工业上的应用不断增加，日本、德国等国家也相继开始机器人的研制。

中国对现代机器人的研制始于上世纪70年代后期，80年代进入到飞速开展时期。

尤其在国家成立了863计划后，机器人技术得到特别的重视，由此中国在机器人领域取得了飞速开展，相继研制出示教再现型的搬运、焊接、喷漆、装配等各种工业机器人，以与水下作业、军事和特种机器人。

机械臂开展状况概括如下：

第一代机械臂，即示教再现方式的机械臂。

目前这种机械臂仍广泛应用于各种场合。

这种工作方式只能按照事先设置的位置进展重复的动作，但是不能感知周围环境，其应用X围因此受到一定的限制。

这类机械臂主要工作于原料搬运、喷漆、焊接等工作场合。

第二代机械臂，即具有视觉、触觉等外部感觉功能的机械臂。

这类机械臂可以根据周围环境的变化进展自适应，故可以完成较为复杂的工作。

图1.1一汽“红旗〞轿车机器人焊接生产线

第三代机械臂，这类机械臂不仅具有第二代机械臂的感觉功能，而且还具有规划和决策的功能。

从而在环境发生变化时进展自主的工作。

但是目前这类机械臂依然处于研究阶段，还需要一段时间才能得到实际应用[6]。

图1.2演奏机器人

从机械臂几十年来的成长进程来看，高精度，多功能，集成化，系统化以与智能化是机械臂在以后多年中的开展方向。

1.1.3机械臂的分类

机械臂一般从运动坐标形式分为直角坐标式机械臂、圆柱坐标式机械臂、极坐标式机械臂和多关节式机械臂。

直角坐标式机械臂：

由三个线性关节来确定手爪的位置，通常还带有附加的旋转关节用来确定末端执行器的姿势。

这类机械臂虽然控制位置精度高、简单，但结构繁杂，占地面积大。

圆柱坐标式机械臂：

由两个滑动关节以与一个旋转关节来确定手爪的位置，也可以再附加一个旋转关节来确定部件的位置。

其位置精度仅次于直角坐标式机械臂，控制简单，但结构庞大，移动轴的设计复杂。

极坐标式机械臂：

它由一个滑动关节以与两个旋转关节来确定手爪的位置，也可以附加一个旋转关节来确定部件的姿势。

这类机械臂占地面积小，结构紧凑，但有平衡问题，位置误差与臂长有关。

多关节式机械臂：

其关节都是旋转的，类似于人的手臂，是工业机械臂中最常见的构型。

该类机械臂结构紧凑，占地面积小，工作空间大，但是位置精度较差，控制存在耦合，比拟复杂。

图1.3~1.6分别对应以上四种机械臂。

图1.3直角坐标式机械臂图1.4圆柱坐标式机械臂

图1.5极坐标式机械臂图1.6多关节式机械臂

作为驱动方式，通常采用液压驱动、气压驱动和电机驱动三种类型。

液压式：

液压驱动机械臂通常由液动机〔各种油缸、油马达〕伺服阀、油泵、油箱等组成驱动系统，由驱动机械臂的执行机构进展工作[7]。

气压式：

其驱动系统通常由气缸、气阀、气罐和空压机组成。

电动式：

电力驱动的机械臂是目前应用最广泛的一种类型。

驱动电机一般采用步进电机、直流伺服电机或交流伺服电机，其中交流伺服电机为目前主要的驱动形式。

由于电机速度高，通常还需要减速机构[8]。

传统的机械臂系统由于占地面积较大，所以在小空间的环境下不适用。

在一些特殊的环境下，我们需要一种占地面积小而且活动灵敏的机械臂。

要实现机械手臂的控制，首先要分析机械手臂的机械结构，其中动力源以与动力传递方法应被予以重视。

现在，电力传动的机械臂得到了广泛的应用，在动力传动方式上，有连杆式、齿轮式、绳索式等。

以关节型为主流，80年代发明的适用于装配作业的平面关节型机械臂约占总量的1/2[9]。

鉴于汽车、建筑、桥梁等行业的需要，超大型机械臂应运而生。

选择一个性能较好的控制器对控制功能的实现来说是十分必要的。

工业控制技术、软件和硬件技术的开展，为机械臂控制器的选择提供的充分的条件。

可编程控制器〔PLC〕由于抗干扰能力强，故障率较低，设备易于扩展、维护，开发周期短等特点，被广泛应用于工业场合[10]。

但是其本钱很高。

数字信号处理器〔DSP〕采用数据和程序别离的哈佛结构和改良的哈佛结构，执行指令速度更快，它以处理能力强、内置较大的存储器、芯片功耗低与配置资源灵活等特点得到了广泛的应用[11]。

但是其本钱较高，高频干扰很大，功率消耗也很大。

FPGA〔Field－ProgrammableGateArray〕灵活，设计周期短的特点使其特别适合用于小批量系统，提高系统的可靠性和集成度[12]。

但是FPGA的功耗非常大，而且跟硬件的的联系非常大，使用起来很有难度[13]。

与上述各种微处理器相比，STM32F103ZET6处理器是意法半导体公司STM32系列芯片的一种，STM32F103ZET6采用ARM最新的Cortex-M3内核，具有低本钱、高集成度、低功耗等优点[14]。

ARM微处理器资源丰富，具有很好的通用性，在很多领域都得到了广泛的应用。

应用于机械臂系统控制方法多种多样，包括传统的PID控制，现代控制的轨迹控制、模糊控制、自适应控制等。

PID控制的实用性很强。

只要三个参数配适宜当，便可实现速敏捷、平稳准确的控制。

工业生产上的机械臂经常采用示教再现的方式。

模糊控制和自适应控制精度高，是现代控制领域中应用广泛的控制方法，尤其表现在军工领域和航天领域中。

机械臂的研究内容除以上主要内容外，智能化传感器的应用、机器人的编程语言以与网络通讯等技术对于机器人系统也有非常重要的意义。

在一般情况下，嵌入式系统是“执行特殊功能并受内部控制器控制的设备或系统〞，即“嵌入到对象体系内的特定计算机系统〞。

“嵌入性〞、“专用性〞与“计算机系统〞是嵌入式系统的三个根本要素。

它主要负责信号的控制，体积小，可作为一个部件嵌入到所控制的装置中。

它提供用户接口、有关管理信息的输入输出等，使设备与应用系统有较高的智能和性价比。

进入微型计算机机时代后，科技人员开始了嵌入式系统的研究，之后迅速进入到独立开展的单片机时代，随后又迅速进入到电子技术领域中[15]。

嵌入式技术的开展不仅使机器人在微型化、智能化等方面具有更明显的优势，同时又使机器人的价格大幅降低，实现了机器人在更多领域广泛的应用。

该设计主要负责四自由度机械臂控制系统相应的软件、硬件的设计与开发。

该设计以四自由度机械臂为控制根底，以STM32F103ZET6为主控芯片，设计的机械臂控制系统，控制精度较高，稳定性较强，具体的内容包括如下几个方面：

1.对机械臂系统的硬件设计进展分析，具体的电路以与芯片的选择进展了较为详细的介绍，并对其可靠性进展了深入的分析。

2.对舵机的控制理论进展了深入的研究，分析讨论了控制系统所涉与的主控芯片。

3.根据四自由度机械臂需要完成的工作任务，编写了系统的软件控制程序，对初始化、运行等模块展开了较为详细的介绍，之后对整个系统进展了反复的调试，调试结果明确，所设计的机械臂控制系统可以实现较为准确的控制。

2机械臂控制系统的总体方案设计

臂部结构设计原如此

作为机械臂的一个重要组成局部，手臂不仅起到支撑被抓物体、手爪和其他关节的作用，而且还可以驱动手爪抓取物体，并根据事先预定的位置将物体搬运到指定地点[16]。

机械臂的结构形式必须基于其运动形式、动作自由度、抓取质量、受力情况和其他的因素来确定，整个系统的总质量比拟大，受力也比拟复杂，其运动部件的质量直接影响到机械臂的刚度和强度。

所以，进展手臂的设计时，一般应注意下述要求：

〔1〕刚度要大。

为了防止机械臂在运动过程中发生较大的形变，要合理选择手臂的截面形状。

〔2〕导向性要好。

为了防止机械臂在运动过程中发生不必要的相对运动，臂杆最好设计成方形或是花键等形式。

〔3〕偏重力矩要小。

要尽可能减小机械臂运动局部的质量。

该设计根据机械臂的功能与搬运工作的任务的特点以与类型，为了使其在一定程度上具有操作的灵活性和运行性能的良好，经过屡次的比拟、讨论后，该设计选用多关节型的机械臂，它不仅具有动作的角度大的优点，还可以使机械臂在更大的空间内的运动。

机械臂的自由度是一个非常重要的参数，取决于机械臂的类型与其结构，并且在很大程度上直接决定到机械臂能否完成预定的任务。

一般来说是根据机械臂的用途来设计机械臂的自由度。

自由度越多的机械臂，具有更大的运动的灵活性，通用性也越强，但结构较复杂，难以实现。

所设计的搬运机械臂采用四个自由度就可以完成设定的搬运任务。

其中机械臂的手臂的旋转关节包括腰关节、肩关节、肘关节和腕关节四个关节以与末端手爪的开合。

工作对象简介

在工业现场采用机械臂进展的工作对象中袋装物品和箱装物品较为是常见的。

在一般的情况下，箱装物品由于具有规如此的外形，多使用吸附式的手爪；而袋装物品由于具有极易产生形变的特点，多使用夹钳式或者插板式的手爪。

在该设计中，由于受机械臂硬件条件的限制，选择夹钳式的手爪搬运箱装物品。

模拟的箱装物品的长、宽、高分别是55mm、36mm和30mm。

在进展工作对象的选择过程中，共有3种型号可供选择。

其中长、宽、高分别是40mm、36mm、和30mm的工作对象由于超声波传感器的反射面较小，所以当其已经运动到指定搬运位置时，传感器不能准确的检测到物体，所以控制精度不够高，放弃采用。

而长、宽、高分别是65mm、36mm和30mm的工作对象对于该手爪来说尺寸较大，在抓取和搬运的过程中经常出现掉落的现象，所以没有采用。

2.3机械臂关节控制的总体方案

作为机械臂的心脏，机械臂控制器是根据程序指令和从传感器获得的传感信息来控制机械臂完成事先预定的动作或任务的装置，控制器的性能决定了机械臂控制性能的好坏。

从计算机结构、控制方式方面来划分，机械臂控制器大约可分为3种：

单CPU集中控制方式、多CPU分布式控制方式、二级CPU主从式控制方式。

〔1〕单CPU集中控制方式：

单CPU集中控制系统必须是一个强大的控制系统，它的全部控制功能是用一台功能强大的计算机实现的。

Hero-Ⅰ、Robot-Ⅰ等这些时代较早的机器人采用的就是这种单CPU集中控制方式的结构，但由于在控制的过程中需要进展大量的计算，因此这种控制方式的控制速度一般比拟慢。

〔2〕多CPU分布式控制方式：

多CPU分布式控制系统的最大特点就是一个CPU负责控制一个关节轴，同时在上位机与单轴控制的CPU之间设计了一个并行接口，其主要负责上、下位机的通信，从而保证了数据的可靠传输。

〔3〕二级主从式控制方式：

该控制方式需要主从两个CPU，即上位机和下位的单片机两层结构。

上位机负责运动轨迹的规划、运动学计算等任务，根据预定的位置，计算出各个关节的运动量，以指令形式传送给下位的微处理器。

下位的微处理器根据指令对各关节进展运动控制。

本课题所设计的机械臂系统基于STM32微处理器，利用STM32强大的运算和处理能力，采用单CPU集中控制方式即可满足要求。

本课题研究的机械臂控制系统采用单CPU集中控制方式，系统框图如下：

图2.1机械臂控制系统结构图

计算机用于完成整个系统的管理、发送指令、运动轨迹规划等。

计算机通过J-Link仿真器将程序下载至STM32微处理器，向关节控制系统发出位置指令，STM32根据指令输出PWM波，从而使机械臂的各个关节转过指定的角度，进而使其按照预定的轨迹完成搬运任务。

本课题设计的机械臂关节控制系统以STM32微处理器为核心，对直流伺服电机〔舵机〕进展较为准确的运动控制。

关节控制系统的工作原理是：

STM32微处理器内部的PWM单元产生PWM信号，驱动直流伺服电机旋转。

电机驱动舵机内部的齿轮组，其输出端带动一个线性的比例电位器作为位置检测，该电位器把转角坐标转换为一比例电压反响给控制线路板，控制线路板将其与输入的控制脉冲信号比拟，产生纠正脉冲，并驱动电机正向或者反向的转动，使齿轮组的输出位置与期望值相符，令纠正脉冲最终趋于为0，从而达到使伺服电机的准确定位[17]。

该关节控制系统的主要特点如下：

〔1〕使用以Contex-M3为内核的STM32F103ZET6作为系统的微控制器，与传统的51单片机相比起来，具有功耗小，运算能力大大增强的优点。

〔2〕采用直流伺服电机驱动机械臂的各个关节，根据STM32微控制器输出的PWM控制信号的占空比来确定直流电动机的转速和转向，控制起来简单，准确。

2.4本章小结

本章介绍了4自由度机械臂的结构形式，根据腰关节、肩关节、肘关节和腕关节4个旋转关节的运动特点，从整体上确定了该机械臂控制系统的控制方案。

首先确定了该关节控制系统采用单CPU集中控制方式，然后说明了关节控制系统的工作原理，最后介绍了本设计的关节控制系统的一些主要特点。

3机械臂控制系统硬件设计

机械臂控制系统通常要满足如下几个根本的要求：

〔1〕控制系统的微型化、轻型化和模块化。

因为机械臂的控制系统是安装在机械臂上的，所以为了安装的方便和减轻机械臂的负载，控制系统应尽可能实现微型化和轻型化；另外，为了达到系统的各单元之间有要求的独立性的目的，要尽量实现模块化。

〔2〕控制系统的实时性。

为了满足机械臂的输入输出信息量大，并且计算量大，同时要保证较高的控制精度的要求，机械臂控制系统必须具有较好的实时性。

〔3〕系统的稳定性和开放性。

稳定是保证系统正常运行的前提和保证，所以机械臂控制系统必须具有一定的稳定性以保证系统的低故障率。

此外，为了实现控制系统以后的改良和可以方便的移植到其他的位置，这就要求控制系统具有好的开放性[18]。

该机械臂控制系统由主控制模块、电机驱动模块和电源模块组成，每个子模块的功能如下：

主控制模块：

作为该控制系统的核心，包括ARMCortex-M3内核和有关外围电路，主要负责完成PWM波〔控制信号〕的输出。

驱动模块：

负责机械臂各个关节的驱动，由舵机组成。

电源模块：

机械臂控制系统采用双电源供电模式，STM32单片机经过经LM2596DC-DC可调降压模块实现供电。

微控制器作为机械臂运动控制系统的核心，其性能对控制效果起着至关重要的作用，因此高性能的CPU是必需的。

微控制器的选择对机械臂系统的设计影响很大，所以要在具体分析了该控制系统的特点和要求后选择适宜的微控制器，应基于整个系统的控制速度与其智能水平两个方面，以如下几个方面为重点进展微控制器的选择：

·系统时钟速度

·运算速度

·功能

·电机控制方式

·ROM与ROM的大小

·控制板的结构尺寸

目前，应用于机械臂的微控制器有很多种，最广泛的有8/16位单片机和数字信号处理器两种。

选择8/16位单片机进展控制系统的设计简单，开发周期较短，但数据处理能力弱，需要附加很多的外部设备如PID调节器和PWM发生器等才能完成较为复杂的控制，而且系统的稳定性不强，开发板尺寸较大。

相比于8/16位单片机，数字信号处理器具有处理能力强、速度快、开发板体积小等特点，但在中断处理、位处理方面，DSP不如单片机的资料多，而且芯片的价格以与其相应的开发软件也比拟贵，针对性性比拟强，但是通用性一般比拟差。

具有同等性能的ARM微处理器与DSP相比，资源更加的丰富，通用性明显增强，它所具有的处理速度快、性价比高、功耗低等优点使其得到了广泛的应用。

虽然作为32位的微处理器，但是由于ARM内部具有16位的Thumb指令集，这使其能够作为16位的单片机使用，却拥有了32位单片机的处理速度。

所以，用单片机和DSP实现的系统，ARM都可以实现。

在上述分析的根底上，经过反复比拟，本设计采用意法半导体公司的STM32处理器，如图3.1所示。

STM32F103ZET6是基于32位ARMCortex-M3内核的微处理器，不但支持实时仿真，而且嵌入了512KB的高速闪存。

CPU的最高工作频率为72MHz，支持Thumb-2。

图3.1STM32

STM32的主要特性如下[19~22]：

·内核为ARM32位的Cortex-M3CPU：

·存储器：

512KB的闪存程序存储器；

64KB的SRAM；

带4个片选的静态存储器控制器。

支持CF卡、SRAM、PSRAM、NOR和NAND存储器。

·时钟、复位和电源管理：

·低功耗：

·3个12位的模/数转换器：

3倍采样和保持功能；

温度传感器。

·2通道12位D/A转换器。

·12通道DMA控制器：

·调试模式：

串行单线调试和JTAG接口；

Cottex-M3内嵌跟踪模块。

·112个快速I/O端口。

·11个定时器。

·13个通信接口。

·CRC计算单元，96位的芯片唯一代码。

该设计的主控制模块的硬件系统包括电源电路、复位电路、系统时钟电路以与JTAG调试电路四大组成局部。

在硬件电路的设计中，电源模块的设计是非常重要的，如果不能妥善处理，不但会使电路不能正常工作，严重的还可能烧毁电路。

因此，在设计电源时务必要注意如下几点：

〔1〕交流输入和直流输出尽可能保持更大的距离；

〔2〕地线要足够粗，单点和多点相结合，同时别离模拟地和数字地；

〔3〕散热要好，布局应适宜；

图