《基于STM32的机械臂运动控制分析设计.doc》由会员分享，可在线阅读，更多相关《基于STM32的机械臂运动控制分析设计.doc（25页珍藏版）》请在金锄头文库上搜索。
1、机器人测控技术大作业课程设计 课程设计名称：基于STM32的机械臂运动控制分析设计 专 业 班 级 ： 自动1302 学 生 姓 名 ： 张鹏涛 学 号 ： 201323020219 指 导 教 师 ： 曹毅 课程设计时间： 2016-4-282016-5-16 指导教师意见：成绩:签名： 年 月 日目录摘要1第一章 运动模型建立21.1引 言21.2机器人运动学模型的建立21.2.1运动学正解4第二章 机械臂控制系统的总体方案设计52.1机械臂的机械结构设计52.1.1臂部结构设计原则52.1.2机械臂自由度的确定62.2机械臂关节控制的总体方案62.2.1机械臂控制器类型的确定62.2.2
2、机械臂控制系统结构72.2.3关节控制系统的控制策略7第三章 机械臂控制系统硬件设计83.1机械臂控制系统概述83.2微处理器选型93.3主控制模块设计93.3.1电源电路93.3.2复位电路103.3.3时钟电路103.3.4 JTAG调试电路113.4驱动模块设计123.5电源模块设计13第四章 机械臂控制系统软件设计144.1初始化模块设计144.1.1系统时钟控制144.1.2 SysTick定时器154.1.3 TIM定时器164.1.4通用输入输出接口GPIO174.1.5超声波传感器模块17总结19参考文献20附录A21附录B22设计要求： 设计一个两连杆机械臂，具体参数自行设计
3、，建立其运动学模型，然后在此基础上完成该机械臂两点间的路径规划，并给出仿真结果。设计完成上述目标的控制系统，控制器可以自行选择（单片机，ARM，DSP，PLC等），其他硬件部分根据系统所需要完成的功能自行选择，基本要求要体现系统的输入，输出信号和人机交互界面，画出整个系统的硬件结构（电路模块，驱动模块，控制模块等）和软件部分。摘要由于机械臂在各行各业中得到了愈来愈广泛的应用，机械臂控制的多样化、复杂化的需要也随之日趋增多。作为当今科技领域研究的一个热点，提高机械臂的控制精度、稳定性、操作灵活性对于提高其应用水平有着十分重要的意义。 经过仔细的分析和研究之后，我选择的是STM32单片机进行控制，
4、而自由臂选择工业中常见的四自由臂进行设计和建模分析，运动的控制选用舵机进行控制。首先根据机械臂系统的控制要求，整体上设计出单 CPU 的系统控制方案，即通过控制主控制器输出的 PWM 波的占空比实现对舵机转动的控制，进而实现各个关节的位置控制。在硬件方面，主要论述了如何以 ARM 微处理器STM32F103ZET6、MG995舵机为主要器件，通过搭建硬件平台和设计软件控制程序构建关节运动控制系统。然后按照结构化设计的思想，依次对以上各部分的原理和设计方法进行了分析和探讨，给出了实际的原理图和电路图。在软件设计方面，按照模块化的设计思想将控制程序分为初始化模块和运行模块，并分别对各个模块的程序进
5、行设计。关键词：四自由度机械臂，STM32，运动模型，脉冲宽度调制第1章 运动模型建立1.1引 言机器人运动学描述了机器人关节与组成机器人的各刚体之间的运动关系。 机器人在工作时，要通过空间中一系列的点组成的三维空间点域，这一系列空间点构成了机器人的工作范围，此工作范围可通过运动学正解求得。此外，根据机器人末端执行器的位置和姿态要求，通过运动学逆解求得各个关节转角，可以实现对机器人进行运动分析、离线编程、轨迹规划等工作。机器人控制的目的就在于它能快速确定位置，这使得机器人的运动学正逆解问题变得更为重要。只有计算与运动学正逆解问题相关的变换关系在尽可能短时间内完成，才能达到快速准确的目的。在运动
6、学方程正解过程中，只体现在矩阵相乘关系上，相对简单。1.2机器人运动学模型的建立本文所研究的机器人由四个旋转关节和四个连杆组成，故为四自由度机器人，如图1.1所示。图1.1用齐次坐标来描述机器人各连杆相对于参考坐标系的空间几何关系；用44的齐次变换矩阵来描述相邻两杆的空间几何关系；从而推导出机器人手爪坐标系相对于参考坐标系的空间位姿关系，利用该法得到的D-H参数如表1所示。图1.2机器人连杆坐标系表1 机器人连杆的D-H参数连杆变换表示连杆坐标系i相对于i-1的变换，根据连杆变换的通式: （1）其中：得到各连杆之间的变换矩阵 （2） （3） （4）式中：s1,s2,s3,s4;c1,c2,cs
7、3,c4分别表示sin1,sin2,sin3,sin4; cos1, cos2, cos3, cos4以下同。由矩阵(1）可知：连杆变换依赖于四个参数和，其中只有一个参数是变化的，对于本文所研究的机器人，显然只有为变量，其余三个参数为常量。1.2.1运动学正解 机器人运动学正解指：在已知机器人各关节变量i(i=1,n)的基础上，求解出机器人末端执行器的位置矢量p和姿态矢量n,o,a的过程。将连杆变换矩阵(2)(4)相乘，便得到了该机器人手爪的运动学方程 (5)其中，机器人手爪姿态方程为机器人手爪的位置方程为为检验所得结果的正确性，取1=90,2=0,3=-90,4=0计算的值。结果为:与图1所
8、示机器人手爪的位姿完全一致，表明所得结果正确。这样只要知道关节变量1,2,3和,4的值，就可以完全确定机器人手爪的位置和姿态。第2章 机械臂控制系统的总体方案设计2.1机械臂的机械结构设计2.1.1臂部结构设计原则作为机械臂的一个重要组成部分，手臂不仅起到支撑被抓物体、手爪和其他关节的作用，而且还可以驱动手爪抓取物体，并根据事先预定的位置将物体搬运到指定地点。机械臂的结构形式必须基于其运动形式、动作自由度、抓取质量、受力情况和其他的因素来确定，整个系统的总质量比较大，受力也比较复杂，其运动部件的质量直接影响到机械臂的刚度和强度。所以，进行手臂的设计时，一般应注意下述要求：（1）刚度要大。为了避
9、免机械臂在运动过程中发生较大的形变，要合理选择手臂的截面形状。（2）导向性要好。为了避免机械臂在运动过程中发生不必要的相对运动，臂杆最好设计成方形或是花键等形式。（3）偏重力矩要小。要尽可能减小机械臂运动部分的质量。该设计根据机械臂的功能及搬运工作的任务的特点以及类型，为了使其在一定程度上具有操作的灵活性和运行性能的良好，经过多次的比较、讨论后，该设计选用多关节型的机械臂，它不仅具有动作的角度大的优点，还可以使机械臂在更大的空间内的运动。2.1.2机械臂自由度的确定机械臂的自由度是一个非常重要的参数，取决于机械臂的类型及其结构，并且在很大程度上直接决定到机械臂能否完成预定的任务。一般来说是根据
10、机械臂的用途来设计机械臂的自由度。自由度越多的机械臂，具有更大的运动的灵活性，通用性也越强，但结构较复杂，难以实现。所设计的搬运机械臂采用四个自由度就可以完成设定的搬运任务。其中机械臂的手臂的旋转关节包括腰关节、肩关节、肘关节和腕关节四个关节以及末端手爪的开合。2.2机械臂关节控制的总体方案2.2.1机械臂控制器类型的确定作为机械臂的心脏，机械臂控制器是根据程序指令和从传感器获得的传感信息来控制机械臂完成事先预定的动作或任务的装置，控制器的性能决定了机械臂控制性能的好坏。从计算机结构、控制方式方面来划分，机械臂控制器大约可分为3种：单CPU 集中控制方式、多CPU 分布式控制方式、二级CPU
11、主从式控制方式。（1）单CPU 集中控制方式：单CPU 集中控制系统必须是一个强大的控制系统，它的全部控制功能是用一台功能强大的计算机实现的。Hero-、Robot- 等这些时代较早的机器人采用的就是这种单CPU 集中控制方式的结构，但由于在控制的过程中需要进行大量的计算，因此这种控制方式的控制速度一般比较慢。（2）多CPU 分布式控制方式：多CPU 分布式控制系统的最大特点就是一个CPU负责控制一个关节轴，同时在上位机与单轴控制的CPU 之间设计了一个并行接口，其主要负责上、下位机的通信，从而保证了数据的可靠传输。（3）二级主从式控制方式：该控制方式需要主从两个CPU，即上位机和下位的单片机
12、两层结构。上位机负责运动轨迹的规划、运动学计算等任务，根据预定的位置，计算出各个关节的运动量，以指令形式传送给下位的微处理器。下位的微处理器根据指令对各关节进行运动控制。本课题所设计的机械臂系统基于STM32微处理器，利用STM32强大的运算和处理能力，采用单CPU 集中控制方式即可满足要求。2.2.2机械臂控制系统结构本课题研究的机械臂控制系统采用单CPU 集中控制方式，系统框图如下：计算机J-Link仿真器舵机关节执行机构STM32关节控制系统图2.1 机械臂控制系统结构图计算机用于完成整个系统的管理、发送指令、运动轨迹规划等。计算机通过J-Link仿真器将程序下载至STM32微处理器，向
13、关节控制系统发出位置指令，STM32根据指令输出PWM 波，从而使机械臂的各个关节转过指定的角度，进而使其按照预定的轨迹完成搬运任务。2.2.3关节控制系统的控制策略本课题设计的机械臂关节控制系统以STM32微处理器为核心，对直流伺服电机（舵机）进行较为精确的运动控制。关节控制系统的工作原理是：STM32微处理器内部的PWM 单元产生PWM信号，驱动直流伺服电机旋转。电机驱动舵机内部的齿轮组，其输出端带动一个线性的比例电位器作为位置检测，该电位器把转角坐标转换为一比例电压反馈给控制线路板，控制线路板将其与输入的控制脉冲信号比较，产生纠正脉冲，并驱动电机正向或者反向的转动，使齿轮组的输出位置与期
14、望值相符，令纠正脉冲最终趋于为0，从而达到使伺服电机的精确定位17。该关节控制系统的主要特点如下：（1）使用以Contex-M3为内核的STM32F103ZET6作为系统的微控制器，与传统的51单片机相比起来，具有功耗小，运算能力大大增强的优点。（2）采用直流伺服电机驱动机械臂的各个关节，根据STM32微控制器输出的PWM 控制信号的占空比来确定直流电动机的转速和转向，控制起来简单，准确。第3章 机械臂控制系统硬件设计3.1机械臂控制系统概述机械臂控制系统通常要满足如下几个基本的要求：（1）控制系统的微型化、轻型化和模块化。（2）控制系统的实时性。（3）系统的稳定性和开放性。该机械臂控制系统由主控制模块、电机驱动模块和电源模块组成，每个子模块的功能如下：主控制模块：作为该控制系统的核心，包括 ARM Cortex-M3 内核和有关外围电路，主要负责完成 PWM 波（控制信号）的输出。驱动模块：负责机械臂各个关节的驱动，由舵机组成。
