毕业设计论文自平衡小车机械结构及控制系统设计.docx

《毕业设计论文自平衡小车机械结构及控制系统设计.docx》由会员分享，可在线阅读，更多相关《毕业设计论文自平衡小车机械结构及控制系统设计.docx（44页珍藏版）》请在第一文库网上搜索。

1、摘要机器人技术是一个集环境感知、轨迹规划、机械手应用等功能于一体的机电一体化系统。它是集中了计算机、机构学、传感技术、电子技术、人工智能及自动控制等多科而形成的高新技术。人类社会始终朝着自动化和智能化方向发展，机器人研发、制造和应用将成为衡量国家科技创新和高端制造业水平的重要标志，是国家科技发展的战略需求。智能机器人的下一步发展将体现在作业能力、人机交互、安全性等诸多方面的提升和改进上。所以，随着社会的发展，智能化已经成为各类产品的主要发展方向，人们也在不断的用科技来改变生活，基于此，我们考虑将平衡车与机械臂相结合，制作一款自平衡服务机器人。本文介绍了基于STM32F1O3单片机的自平衡小车系

2、统的设计。系统基于陀螺仪，利用P1D平衡算法，对小车的速度倾斜角度平衡状态来进行检测，并通过单片机来控制电机来实现小车平衡地运动。系统中采用舵机控制板控制舵机，使机械臂完成一定的动作。本次设计将手机与机器人联系起来，通过手机可以向平衡小车发送命令，平衡小车也可以将自身的数据发送到手机上，从而可以通过手机实时地控制小车，也能在手机上观察到小车的状态。此款机器人主要针对办公室生活和家庭生活中，他可以为在我们疲惫的时候为我们跳一支舞蹈，通过手机蓝牙控制机器人的活动，方便快捷。希望我们的这个机器人可以为我们的生活提供方便，使得我们的生活更为简单。关键词：自平衡机械臂手机控制目录第一章设计综述I1.1

3、项目概述I1.1.1 项目背景11. 1.2研究现状11.2 系统设计任务概述31.3 课程设计主要内容3第二章方案设计41.4 机械结构方案设计41.5 驱动方案选择51.6 传感器的选择62. 3.1姿态检测传感器62. 3.2速度传感器62.4结构的合理性8第三章机械系统设计83. 1机械系统总体方案83.2关键尺寸设计93. 3关键零部件结构设计93.4驱动关节运动轨迹规划IO第四章控制系统设计114. 1控制系统总体方案114.2 运动控制器选型114 .2.1电机驱动模块115 .2.2驱动电机控制电路设计124.3 传感检测外围电路设计134.4 电源供电电路设计13第五章软件系

4、统设计145. 1软件系统总体方案145.2 平衡控制方案与流程145. 2.1PID算法简介146. 2.2直立控制157. 2.3速度控制168. 2.4转向控制175.3 蓝牙控制方案185. 3.1基本配置185. 3.2串口3接收中断195.4 舵机控制方案205 .4.1基本配置206 .4.2发送数据函数205.5 手机APP控制端介绍225.5.1界面介绍225.5.2控制方法23第六章装配与调试246.1 机器人系统整体装配246.2 系统调试流程246.3 设计创新点256.4 系统缺陷与改进25第七章市场应用前景分析257.1 市场调查分析257.2 市场行业分析267.

5、3 目标市场的确定以及市场实施267.4 产品未来市场描述27第八章总结及感想278.1项目总结278.2感想28参考文献29附录一材料清单附录二程序源代码第一章设计综述1.1 项目概述1.1.1 项目背景机器人(RObOt)是自动执行工作的机器装置。它既可以接受人类指挥，又可以运行预先编排的程序，也可以根据以人工智能技术制定的原则纲领行动。它的任务是协助或取代人类工作的工作，例如生产业、建筑业，或是危险的工作。中国的机器人专家从应用环境出发，将机器人分为两大类，即工业机器人和特种机器人。所谓工业机器人就是面向工业领域的多关节机械手或多自由度机器人。而特种机器人则是除工业机器人之外的、用于非制

6、造业并服务于人类的各种先进机器人，包括：服务机器人、水下机器人、娱乐机器人、军用机器人、农业机器人、机器人化机器等。在特种机器人中，有些分支发展很快，有独立成体系的趋势，如服务机器人、水下机器人、军用机器人、微操作机器人等。国际上的机器人学者，从应用环境出发将机器人也分为两类：制造环境下的工业机器人和非制造环境下的服务与仿人型机器人，这和中国的分类是一致的。电动平衡车，又叫体感车、思维车、摄位车等。市场上主要有独轮和双轮两类。其运作原理主要是建立在一种被称为动态稳定(DynanIiCStabi1ization)的基本原理上，利用车体内部的陀螺仪和加速度传感器，来检测车体姿态的变化，并利用伺服控

7、制系统，精确地驱动电机进行相应的调整，以保持系统的平衡。是现代人用来作为代步工具、休闲娱乐的一种新型的绿色环保的产物。本次项目即为将机械手结构与平衡车相结合，使平衡车的便携性、趣味性与机械手的功能性相结合，实现机器人服务于人类的想法。1.1 .2研究现状近年来，国内外多家科研单位和企业以及自平衡代步车的爱好者都对自平衡理论的发展做出了许多的有益的贡献,大大推进了自平衡技术的发展，同时也出现了一批有代表性的自平衡机器人和载人代步车作品。2002年，美国1ego公司的SteveHassenp1ug设计了如图1.1所示的两轮自平衡传感式机器人1egwayo这个设计引入了电机的差动驱动方式，它可以工作

8、在倾斜面甚至不规则表面上，可遥控操作。通过对电动机进行遥控，1egway可以在前行，后退和转弯时保持平衡，可以实现零半径转弯和U型回转。图1.11egway图1.2NEXTway2007年，日本早稻田大学的AyoWatanabo在1egway的启发下设计制作了NXTway,如图12所示。2002年，三洋电机展示了可依靠上体倒立来保持平衡的双轮行走机器人F1ATHRU,如图13所示,大小为602x463x564mm,重20kg。移动速度方面，平地行走时最大30Cm1S,可搬运重量最大为IOkg,运行时间约为1小时。车轮中嵌有一个输出功率为90W的直流电动机，头部则嵌入了两个相同的电动机。为了检测

9、上体的平衡情况，使用了3个陀螺仪和1个3轴加速度传感器。深圳固高科技有限公司研制的教学用自平衡小车，如图1.4所示，大小为260InnIX45OmmX730mm,使用85W减速比10:1的直流伺服电机，最大移动速度1.6ms,24V银氢电池供电，电源持续工作时长大于1.5小时，最大爬坡角度20度。2002年，美国SegWay公司开发了世界上第一部能够自平衡的两轮电动车，时速高达20kmh,如图1.5所示。该电动车把人们从传统的“三点平衡”和以低重心、大而稳的底盘设计来避免倾斜的束缚中解脱出来，通过检测车体的角度和角速度，用适当的回复转矩来避免倾斜摔倒。SegWay使用的是航空级陀螺仪、一组倾斜

10、传感器、一套复杂的“直觉软件”、一个加速度计、十个微处理器、两个银氢电池组、一台电动机和每秒检测一百多次驾驶者重心的传感器。2007年，美国麻省理工学院的几名学生设计制作出了一台自平衡小车，如图1.6所示。中心处理器采用的PIC单片机，主程序采样频率达IOOHz,传感器采用惯性元件陀螺仪和加速度计。以上是国内外两轮自平衡机器人和自平衡代步车的研究现状。这些机器人和代步车对本课题的研究提供了很好的指导作用，为下面的研究工作提供了很好的参考。1.2 系统设计任务概述（1）机器人能够实现自平衡；（2）机械手臂可以完成特定的动作；（3）实现蓝牙控制，可以通过手机软件控制小车的前进、后退、转弯以及机械臂

11、的动作；1.3 课程设计主要内容（1）资料分析：查阅相关文献资料，对资料进行分析总结。（2）机器人总体设计：确定机器人的具体任务要求，根据任务初步拟定机器人的技术参数、运动形式、机械结构、驱动方案、传动方案、控制方案等。（3）机器人机械结构设计：将机器人分解为车身结构、机械臂和车轮等若干部分，分别对各个结构的关键部件进行详细设计并校核，绘制机器人总装图和关键零部件图。（4）传感和信息检测及信息传输：根据任务要求，完成相关信息检测、处理，并完成信息的正确传输。（5）运动控制方案设计：基于传感信息，采用STM32完成机器人控制系统硬件和软件的设计和系统调试。（6）编制课程设计说明书。第二章方案设计

12、2.1机械结构方案设计所设计机械结构整体图如图2.1所示。常用在机器人中的电机有三种类型：直流减速电机、步进电机、伺服电机,其特点及优点如表格1所示。表格1不同电机比较类型特点优点直流减速电机是在普通直流电机的基础上，加上配套齿轮减速箱。齿轮减速箱的作用是，提供较低的转速，较大的力矩。低转速，大力矩。步进电机将电脉冲信号转变为角位移或线位移。它的旋转是以固定的角度一步一步地运行。通过控制脉冲个数来控制角位移量达到准确定位的目的。伺服电机1体积小、动作快反应快、过载能力大、调速范围宽。2.低速力矩大，波动小，运行平稳。3.低噪音,高效率。可使控制速度，位置精度非常准确，可以将电压信号转化为转矩和

13、转速以驱动控制对象。由于直流减速电机控制较简单，能够提供较大力矩，成本低，所以最终选择直流减速电机。具体型号为:JGA25-371减速电机,如图2.2。选择TB6612FNG电机驱动模块，如图2.3。图2.2JGA25-371减速电机图2.3TB6612FNG电机驱动模块2.3传感器的选择2.3.1姿态检测传感器选择MPU6050陀螺仪，如图2.4所示，其引脚如图2.5所示。本设计中所采用的陀螺仪加速度设模块为MPU6050,之所以选择这个模块，是因为其有以下优点：（1）集角度测量与加速度测量于一体；（2）其那同时测量三轴上的角度与加速度测量；（3）其输出为数字信号，便于处理于存储与传输；（4

14、）测量范围大，反应快。2.3.2速度传感器采用光码盘测速模块。此模块有以下优点：（1）测速精度高，反应快，因为其一圈有高达60个栅格；（2）能测正反转。使用时，长时间挡住或者不挡均没有输出，作为相位检测，只有在对射的上升沿和下降沿才会有波形输出，所以转动码盘或者用不透明物体来回切换状态的时候才会有方波输出，高速状态下，类似正弦波或者锯齿波。光码盘测速原理图如图2.6所示。示波器波形检测如图2.7所示。O图2.6光码盘测速原理图无需外部电路，接上5V与GND,信号线跃出信号右轮光码盘电机正反转影响第二个脉冲信号，与第一个脉冲信号的错位左轮光码盘：；单片机信号处理：（5V高低电平）4W1Tf1ru

15、r图2.7示波器波形检测2.4结构的合理性（1）整体结构连接处采用螺栓进行连接，关键部位采用双螺母防松，整体连接稳定可靠；（2）系统前后左右采取对称设计，有利于平衡车平衡；（3）平衡车机械臂和车体部分采用圆柱支撑，强度大，不易抖动，稳定性高；（4）机械臂部分采用专用舵机架连接，精度高，稳定性好。第三章机械系统设计3.1 机械系统总体方案图3.1机械系统总体方案机械系统总体由机械臂和车体组成，如图3.1所示。机械臂由舵机和舵机支架组成。车体由轮胎、1形支架、电机、联轴器、亚克力板、支撑柱、螺栓、螺母等组成。3.2 关键尺寸设计首先由舵机及舵机支架组合成为机械臂，基于此设计小车整体尺寸，为:425.8300464.08o机器人三块支撑板设计分别见图纸所示。3.3 关键零部件结构设计机械臂部分采用U形舵机架等通过螺栓进行连接，如图3.2所示。车轮部分由1形支架、电机