ImageVerifierCode 换一换
格式:DOC , 页数:37 ,大小:409KB ,
资源ID:1753710      下载积分:20 金币
快捷下载
登录下载
邮箱/手机:
温馨提示:
快捷下载时,用户名和密码都是您填写的邮箱或者手机号,方便查询和重复下载(系统自动生成)。 如填写123,账号就是123,密码也是123。
特别说明:
请自助下载,系统不会自动发送文件的哦; 如果您已付费,想二次下载,请登录后访问:我的下载记录
支付方式: 支付宝    微信支付   
验证码:   换一换

加入VIP,免费下载
 

温馨提示:由于个人手机设置不同,如果发现不能下载,请复制以下地址【https://www.docduoduo.com/d-1753710.html】到电脑端继续下载(重复下载不扣费)。

已注册用户请登录:
账号:
密码:
验证码:   换一换
  忘记密码?
三方登录: 微信登录   QQ登录   微博登录 

下载须知

1: 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。
2: 试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓。
3: 文件的所有权益归上传用户所有。
4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
5. 本站仅提供交流平台,并不能对任何下载内容负责。
6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

版权提示 | 免责声明

本文(毕业设计(论文)-山茶采摘平台设计研究(含全套CAD图纸).doc)为本站会员(QQ153893706)主动上传,道客多多仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对上载内容本身不做任何修改或编辑。 若此文所含内容侵犯了您的版权或隐私,请立即通知道客多多(发送邮件至docduoduo@163.com或直接QQ联系客服),我们立即给予删除!

毕业设计(论文)-山茶采摘平台设计研究(含全套CAD图纸).doc

1、全日制普通本科生毕业设计山茶采摘平台设计研究DESIGN AND RESEARCH OF THE CAMELLIA PICKING PLATFORM由于部分原因,说明书已删除大部分,完整版说明书,CAD图纸等,联系 153893706 学生姓名: 学 号:年级专业及班级: 2008 级机械设计制造及其自动指导老师及职称: 学 部: 理工学部提交日期:2012 年 5 月全日制普通本科生毕业论文(设计)诚信声明本人郑重声明:所呈交的本科毕业论文是本人在指导老师的指导下,进行研究工作所取得的成果,成果不存在知识产权争议。除文中已经注明引用的内容外,本论文不含任何其他个人或集体已经发表或撰写过的作品

2、成果。对本文的研究做出重要贡献的个人和集体在文中均作了明确的说明并表示了谢意。同时,本论文的著作权由本人与湖南农业大学东方科技学院、指导教师共同拥有。本人完全意识到本声明的法律结果由本人承担。作者签名: 年 月 日目 录摘 要 .1关键词 .11 前言 11.1 研究意义与目的 2 1.2 国内外研究现状 22 山茶采摘平台创意设计与方案 62.1 机器人一般组成 62.2 山茶采摘平台设计方案 62.3 研制概要 73 采摘平台机械设计 73.1 底盘的设计 73.1.1 基于 45全向轮的分析 73.1.2 一种山地行走系统用全向履带 .103.2 升降机构的设计 .114 采摘平台电路硬

3、件电路设计 .134.1 系统原理框图 .134.2 采摘主控制板结构及说明 .134.2.1最小系统 144.2.2 主控制板实物图 .144.3 电源模块 .154.4 伺服电机驱动电路 .164.5 按键电路 .205 主控制板程序设计 .215.1 系统主程序流程图 .215.2 PWM的产生 215.2.1 软件生成 PWM215.2.2 硬件生成 PWM236 系统的调试 .257 总 结 25参考文献 25致 谢 26附录 271山茶采摘平台设计研究摘 要: 随着国内外采摘机器人的兴起,21 世纪是农业机械化向智能化方向发展的重要历史时期,机械作业已逐步进入农业生产领域。本文研究

4、设计了能减轻人工劳动强度和提高工作效率的山茶采摘平台,平台由主控模块、行走模块(全向履带)和升降模块组成。系统以 STM32为核心控制器,通过对伺服电机的控制可实现采摘平台的行走控制和升降控制。本文结合由铝型材制作的采摘平台的实物模型对系统的设计进行了分析和总结。关键词:机器人;农业机械化;采摘平台;全向履带Design and research of the camellia picking platformAbstract: With the rise of the picking robot at home and abroad, the 21st century is an impor

5、tant historical period of the mechanization of agriculture to the intelligent direction, the robot has gradually entered the field of agricultural production. This study design can reduce labor intensity and improve the efficiency of the camellia picking platform, This picking platform by walking mo

6、dule(Omni-track), lifting module and main control module. The system use the STM32 as the core controller. The control of servomotor can be achieved walking and lifting of the picking platform. The design of the physical model produced by the aluminum picking platform system was analyzed and summari

7、zed in this paper.Key words: Robot; mechanization of agriculture; picking platform; Omni-track1 前言机器人技术的发展是一个国家高科技水平和工业自动化程度的重要标志和体现。机器人涉及多学科交叉综合;人工智能、机器人技术、通信技术、传感器技术、仿生学、机构学、信息及编程技术、计算机学、材料学、电子技术、传动技术、接口技术、电机拖动学、精密机械技术、自动控制理论、伺服传动技术等诸多领域的技术集成,代表高技术的发展前沿,是当前科技研究的热点方向。21 世纪是农业机械化向智能化方向发展的重要历史时期。我国是一

8、个农业大国,要实现农业现代化,农业装备的机械化、智能化是发展的必然趋势。随着计算机和自动控制技术的迅速发展,机器人已逐步进入农业生产领域。采摘机器人作为农业机器人的重要类型,其作用在于能够降2低工人劳动强度和生产费用、提高劳动生产率和产品质量、保证果实适时采收,使其具有很大的发展潜力 1。1.1 研究意义与目的农业是国民经济的基础, 这是不以人们意志为转移的客观经济规律。农业生产力发展的水平和农业劳动生产率的高低, 决定了农业为其他部门提供剩余产品和劳动力的数量, 进而制约着这些部门的发展规模和速度。近年来,采摘作业的效率提高问题已成为农业经济发展需突破的瓶颈问题之一,目前在国内,果实采摘的成

9、本普遍比较高,效率也低,人工采摘成为制约各地生产效率提高的一个瓶颈。在各地的采摘作业基本上还是手工完成,随着人口的老龄化和农业劳动力的减少,农业生产成本也将提高。因此推广发展机械化收获采摘技术和研究具有重要的意义 。现今国内外有某些公司已经解决了机器采茶的问题,但是由于该机器结构复杂,核心机构和工作部件需要进口,价格昂贵。而且该机的易损部件也是核心零部件还不能国产化,导致使用成本大大提高,所以国内的机械化采茶的效率还很低,中小型茶农也很难购买该类机器,即使有能力购买采摘机,高昂的使用维护成本会使茶农的种植收益大打折扣。针对这种状况,本文主要以山茶采摘平台作为研究对象,目标是提高采摘工作效率,降

10、低茶农成本,提高利润 2。山茶采摘平台行走控制系统设计的目的是用先进的机械化来替代繁重且低效益的农业生产方式,使农民采摘作业的更高效、更科学化、更省力。利用山茶采摘平台行走控制系统实现对果实成熟时采摘的机械化,智能化。极大地提高了采摘的工作效率,降低了人工作业的工作强度。1.2 国内外研究现状 收获作业的自动化和机器人的研究始于 20世纪 60年代的美国(1968 年),采用的收获方式主要是机械震摇式和气动震摇式,其缺点是果实易损,效率不高,特别是无法进行选择性的收获。从 20世纪 80年代中期开始,随着电子技术和计算机技术的发展,特别是工业机器人技术、计算机图像处理技术和人工智能技术的日益成

11、熟,以日本为代表的西方发达国家,包括荷兰、美国、法国、英国、以色列、西班牙等国家,在收获采摘机器人的研究上做了大量的工作,试验成功了多种具有人工智能的收获采摘机器人,如番茄采摘机器人、葡萄采摘机器人、黄瓜收获机器人、西瓜收获机器人、甘蓝采摘机器人和蘑菇采摘机器人等。 (1) 机器人可能成为美国农场的重要组成部分 由于美国政府采取了更加严格的边境管理政策,一些依靠外来移民劳动力的农场3主正将他们的视野转向一种正在发展中的新一代摘果机器人。此类机器人可以从事从采集酿酒用的葡萄直至清洗和摘取莴苣心的工作。 目前这类机器人正处于全面发展时期,将成为收获精致水果和蔬菜的基本工具,目前这些工作仍由手工完成

12、。圣地亚哥视觉机器人技术发明者德里克莫里卡瓦认为:新采摘机器人要依靠先进的运算能力和液压技术,使机器手臂和手指具有近似于人手灵敏度的能力。现代成像技术同样也使机器能够识别和挑选各种品质的水果和蔬菜。方法就是将一台机械化扫描机器送入果园。装备有数字成像技术设备的机器人能够生成一张三维地图,显示位置、成熟度和水果质量。一台采摘机器人按照这些画面,使用他们的长机械臂仔细地采集成熟了的水果。加州柑橘研究委员会和华盛顿苹果委员会合作开发一种水果采摘机器人。上个月研究人员对原型机进行了检测,但是距离真正的广泛商业应用还有很长的路要走。另外,加州州立大学弗雷斯诺分校一个葡萄酒专家小组正在研制一种自动采摘机器

13、人,目的是使葡萄酒业实现更多的机械化。该新技术包括一种称之为近红外线分光计的装置,它可以在采摘之前检测葡萄样品中的糖含量和化学成分。然后利用这些数据绘制一幅全球定位系统地图,收割机器人可以使用这些地图进行导航,在葡萄园中采摘特定的理想成熟葡萄串。位于萨利纳斯山谷的拉姆齐黑蓝德公司销售能够部分自动使用带状锯或水刀的机器人,机器人从地面收割莴苣,并将莴苣进行装箱,以便清洗和加工。该公司首席执行官弗兰克梅肯纳奇称,拉姆齐黑蓝德公司开发的一种新机器模型已接近完工,这种新机器人可以采摘、清洗、取心和对莴苣和其他绿色蔬菜进行打包。(2) 日本的果蔬采摘机器人 自 1983年第一台西红柿采摘机器人在美国诞生

14、以来,采摘机器人的研究和开发历经 20多年,日本和欧美等国家相继立项研究采摘苹果、柑桔、西红柿、西瓜和葡萄等智能机器人。目前,日本在水果采摘机器人领域中研究颇丰,其研究出的采摘机器人主要有以下几类。西红柿采摘机器人 1日本 KondoN等人研制的西红柿收获机器人,由机械手、末端执行器、视觉传感器和移动机构等组成。西红柿一簇可长 4-6个果实,各个果实不一定是同时成熟,并且果实有时被叶茎挡住,收获时要求机械手活动范围大,能避开障碍物,所以机器人的采摘机械手设计成具有 7自由度,能够形成指定的采摘姿态进行采摘。末端执行器由两个机械手指和一个吸盘组成;视觉传感器主要由彩色摄 像机来寻找和识别成熟果实

15、,利用双目视觉方法对目标进行定位;移动机构采用 4轮结构,能在垄间自动4行走。采摘时,移动机构行走一定的距离后,就进行图像采集,利用视觉系统检测出果实相对机械手坐标系的位置信息,判断西红柿是否在收获的范围之内,若可以收获,则控制机械手靠近并摘取果实,吸盘把果实吸住后,机械手指抓住果实,然后通过机械手的腕关节拧下果实。 草莓采摘机器人 2Kondo-N等人还针对草莓的不同栽培模式(高架栽培模式和传统模式)研制出了相应的采摘机器人。高架栽培模式由于适合机器人作业被越来越多地采用。该机器人采用 5自由度采摘机械手,视觉系统与西红柿采摘机器人类似,末端执行器采用真空系统加螺旋加速切割器。收获时,由视觉

16、系统计算采摘目标的空间位置,接着采摘机械手移动到预定位置,末端执行器向下移动直到把草莓吸入;由 3对光电开关检测草莓的位置,当草莓位于合适的位置时,腕关节移动,果梗进入指定位置,由螺旋加速驱动切割器旋转切断果梗,完成采摘。 黄瓜采摘机器人 3黄瓜采摘机器人,采用 6自由度的机械手,能在倾斜棚支架下工作,这种支架栽培方式是专门为机械化采摘而设计。黄瓜果实在倾斜棚的下侧,便于黄瓜与茎叶分离,使检测与采摘更容易。在摄像机前加了滤波片,根据黄瓜的光谱反射特性来识别黄瓜。其末端执行器上装有果梗探测器、切割器和机械手指。采摘时由机械手指抓住黄瓜后,果梗探测器寻找果梗,然后切割器切断果梗。 功能葡萄采摘机器

17、人 4葡萄采摘机器人采用 5自由度的极坐标机械手,末端的臂可以在葡萄架下水平匀速运动。视觉传感器一般采用彩色摄像机,采用 PSD三维视觉传感器效果更好些,可以检测成熟果实及其距离信息的三维信息。在开放式的种植方式下,由 于采摘季节太短,单一的采摘功能使得机器人的使用效率太低,因此开发了多种末端执行器,如分别用于采摘和套袋的末端执行器、装在机械手末端的喷嘴等。 用于葡萄采摘的末端执行器有机械手指和剪刀,采摘时,用机械手指抓住果房,用剪刀剪断穗柄。除了以上介绍的几种类型的采摘机器人,日本还开发了用于柑橘采摘、蘑菇和西瓜收获等的机器人。目前,果蔬采摘机器人的智能水平还很有限,离实用化和商品化还有一定

18、的距离。主要存在的问题,一是果实的识别率和采摘率不高,损伤率较高;二是果实的平均采摘周期较长;三是采摘机器人制造成本较高;随着传感器及计算机视觉等技术的发展,果蔬采摘机器人的研究还需在以下几个方面进行努力:一是要找到一种可靠性好、精度高的视觉系统技术,能够检测出所有成熟果实,精确对其定位;二是提5高机械手和末端执行器的设计柔性和灵巧性,成功避障,提高采摘的成功率,降低果实的损伤率;三是要提高采摘机器人的通 用性,提高机器人的利用率。 (3) 荷兰的黄瓜采摘机器人 1996年,荷兰农业环境工程研究所(MAG)研制出一种多功能黄瓜收获机器 2人。该研究在荷兰 2hm的温室里进行,黄瓜按照标准的园艺

19、技术种植并把它培养为高拉线缠绕方式吊挂生长。该机器人利用近红外视觉系统辨识黄瓜果实,并探测它的位置。机械手只收获成熟黄瓜,不损伤其他未成熟的黄瓜。采摘通过 末端执行器来完成,它由手爪和切割器构成。机械手安装在行走车上,行走车为机械手的操作和采摘系统初步定位。机械手有 7个自由度,采用三菱公司(Mitsubishi)RV-E26 自由度机械手,另外在底座增加了一个线性滑动自由度。 收获后黄瓜的运输由一个装有可卸集装箱的自走运输车完成。整个系统无人工干预就能在温室工作。试验结果为工作速度 10s/根,在实验室中效果良好,但由于制造成本和适应性的制约,还不能满足商用的要求。(4) 英国的蘑菇采摘机器

20、人 英国 Silsoe研究院研制了蘑菇采摘机器人,它可以自动测量蘑菇的位置、大小,并选择性地采摘和修剪。它的机械手包括 2个气动移动关节和 1个步进电机驱动的旋转关节;末端执行器是带有软衬垫的吸引器;视觉传感器采用 TV摄像头,安装在顶部用来确定蘑菇的位置和大小。采摘成功率在 75%左右,采摘速度为 617个/s,生长倾斜是采摘失败的主要原因。如何根据图像信息调整机器手姿态动作来提高成功率和采用多个末端执行器提高生产率是亟待解决的问题 3。 (5) 国内研究进展 在国内,果蔬采摘机器人的研究刚刚起步。东北林业大学的陆怀民研制了林木球果采摘机器人,主要由 5自由度机械手、行走机构、液压驱动系统和

21、单片机控制系统组成。采摘时机器人停在距离母树 35m,操纵机械手回转马达对准母树。然后,单片机控制系统控制机械手大、小臂同时柔性升起达到一定高度,采摘爪张开并摆动,对准要采集的树枝,大小臂同时运动,使采摘爪沿着树枝生 长方向趋近 1.52m,然后采摘爪的梳齿夹拢果枝,大小臂带动采集爪按原路向后返回,梳下枝上球果,完成一次采摘。这种机器人效率是 500 kg/天,是人工 的 3050 倍。而且,采摘时对母树的破坏较小,采净率高。另外,郭峰等运用彩色图像处理技术和神经网络理论,开发了草莓拣选机器人,采用气动驱动器将草莓推到不同的等级方向。浙江大学的应义斌等完成了水果自动分级机器人的研究开发。赵杰文

22、等研究了基于 HIS颜色特征的田6间成熟番茄识别技术,该方法对田间成熟番茄之间相互分离的情况有很好的识别效果。梁喜凤等为分析并改善番茄收获机械手运动学特性进行了番茄收获机械手运动学优化与仿真试验,取得了较好的效果 2。2 山茶采摘平台创意设计与方案2.1 采摘机器人一般组成采摘机器人一般由执行机构、驱动装置、检测装置和控制系统和复杂机械等组成。执行机构即机器人本体,其臂部一般采用空间开链连杆机构,其中的运动副(转动副或移动副)常称为关节,关节个数通常即为机器人的自由度数。根据关节配置型式和运动坐标形式的不同,机器人执行机构可分为直角坐标式、圆柱坐标式、极坐标式和关节坐标式等类型。 驱动装置是驱

23、使执行机构运动的机构,按照控制系统发出的指令信号,借助于动力元件使机器人进行动作。它输入的是电信号,输出的是线、角位移量。机器人使用的驱动装置主要是电力驱动装置,如步进电机、伺服电机等,此外也有采用液压、气动等驱动装置。 检测装置的作用是实时检测机器人的运动以及工作情况,根据需要反馈给控制系统,与设定信息进行比较后,对执行机构进行调整,以保证机器人的动作符合预定的要求。控制系统有两种方式。一种是集中式控制,即机器人的全部控制由一台微型计算机完成。另一种是分散式控制,即采用多台微机来分担机器人的控制,如当采用上、下两级微机共同完成机器人的控制时,主机常用于负责系统的管理、通讯、运动学和动力学计算

24、,并向下级微机发送指令信息;作为下级从机,各关节分别对应一个CPU,进行插补运算和伺服控制处理,实现给定的运动,并向主机反馈信息。2.2 山茶采摘平台设计方案对于智能可升降式移动平台来说,其主要性能是平台运行过程中的稳定性、准确性、安全性以及可操作性。通过学习和总结以往的各种产品,拟定了采摘平台的设计方案如下:1、移动底盘采用自主研究设计的山地行走系统用全向履带,使采摘平台适用于山区地形,而且在坡地行走的转向过程中无需调整履带的朝向,降低了操作的复杂度,提高了行走的稳定性。72、升降机构采用行星齿轮啮合折叠式升降结构,其具有升降平稳准确、运输状态尺寸小、安全可靠等优点,结构紧凑使其生产作业轻松

25、自如。 3、控制系统主控芯片采用 STM32系列,其芯片高性能、低成本、低功耗的嵌入式应用等特点,在复杂的作业中更稳定和实用以及方便工业方面的改装。2.3 研制概要课题要求设计山茶采摘平台,目的是减轻人工的劳动强度,提高工作效率。系统主要包含以下内容:1. 采摘平台的底盘结构设计:要求结合山茶生长区的地域特点,设计适合于该地形行走的底盘结构,并且具有较强的负载能力。2. 采摘平台的升降结构设计:要求结合山茶树的外形尺寸特征,设计具有一定行程的升降系统,实现采摘平台的上升与下降,以达到方便采摘山茶的目的。3. 采摘平台的电气控制系统设计:结合各单元的机械结构,设计对应的电气控制系统实现对相应动作

26、的控制。3 山茶采摘平台机械设计3.1 底盘的设计3.1.1 基于 45全向轮的分析作为移动机器人而开发的移动机构种类已相当繁多,仅就地面移动而言,移动机构就有车轮式、履带式、腿脚式、躯干式等多种形式。其中全方位轮式移动机构无需车体做出任何转动便可实现任意方向的移动,并且可以原地旋转任意角度,运动非常灵活,可沿平面上任意连续轨迹走到要求的位置。(1) 单个辊子的运动原理45全向轮外形像一个斜齿轮,轮齿是能够转动的鼓形辊子,辊子的轴线与轮的轴线成 角度。这样的特殊结构使得轮体具备了三个自由度:绕轮轴的转动和沿辊子轴线垂线方向的平动和绕辊子与地面接触点的转动。这样,驱动轮在一个方向上具有主动驱动能

27、力的同时,另外一个方向也具有自由移动(被动移动)的运动特性。轮子的圆周不是由普通的轮胎组成,而是分布了许多小滚筒,这些滚筒的轴线与轮子的圆周相切,并且滚筒能自由旋转。当电机驱动车轮旋转时,车轮以普通方式沿着垂直于驱动轴的方向前进,同时车轮周边的辊子沿着其各自的轴线自由旋转。图1为45全向轮的各结构和运动参量。8图 1 45全向轮运动参量的定义Fig 1 45Omni-wheel movement marameters of the definition(2) 全方位轮协调运动原理图 2 为采用全方位移动机构的车轮组合情况,轮中的小斜线表示触地辊子的轴线方向。每个全方位轮都由一台直流电机独立驱动

28、,通过四个全方位轮的转速转向适当组合,可以实现机器人在平面上三自由度的全方位移动。4 个全方位轮组成的机器人底座的力分析如图,其中 f 为轮子滚动时小辊子受到轴向的摩擦力;F 为小辊子做从动滚动时受到的滚动摩擦力; 为各轮转动的角速度 4。图 2 组合运动图Fig 2 Combined motion map四边形底盘:动力轮分布在底盘的四个方向两两同轴且相互垂直,轮心到 P底盘重心 O 的距离都等于 a 如下图所示,假设每个轮子与地面的摩擦力分别为 f1、f2、f3、f4,9按照力学公式推导如下:图 3 四边形底盘分析Fig.3 Chassis Of QuadrilateralFx = f1

29、+ f3Fy = f2 + f4Mo = (f1 * a) + (f2 * a) + (f3 * a) + (f14 * a)当 f1 = f3; f1 与 f3方向相同 f2 = f4 = 0 此时机器人向 X方向运动 1当 f2 = f4; f2 与 f4方向相同 f1 = f2 = 0 此时机器人向 Y方向运动 2f1 = f2 = f3 = f4;f1 与 f3 方向相反 f2 与 f4 方向相反时此时机器人原地旋转 3f1 = f3 = F1,f2 = f4 = F2;F1 方向与 F2 相反 此时机器人向 F1 与 F2 的合力方 4向移动。(3) 45全向轮的参数设计假设图 4

30、中所示的圆柱是全方位轮的理论设计圆柱,曲线 AB 是轮子滚动时辊子与地面的接触线。曲线 AB 是等速螺旋线,曲线 AB 绕直线 AB 旋转一周就形成了全方位轮辊子的曲面。 10图 4 辊子生成图 5Fig 4 Roller generated map由上述模型设计如下参数:辊子最小端半径 rmin(mm); 辊子轮廓上任意一点相对于 AB 的距离 及其最大值 max(mm)和最小值 min (mm),由前面的推导知道 minr min,辊子最大半径 rmax = max;辊子轴线与轮子 Z 轴的夹角 (rad);辊子轴线与轮子 Z 轴的最小距离 Smin (mm);辊子的数目 N;辊子的长度

31、l(mm);轮子的实际宽度 b(mm)。(4) 模型分析 6运动学模型是全方位轮协调无碰运动轨迹时规划的理论依据,而动力学模型是研究动态环境下的实际时变运动规划问题的基础。运动学建模可以从理论上证明全方位轮是如何协调实现机器人的全方位运动的,并且为进一步建立动力学模型提供基础。本文作了三个合理的假设:忽略本体及辊子的柔性; 1忽略工作场地的不规则,即四个全方位轮能同时正常运转; 2全方位轮与工作面有足够大的摩擦力,轮体不存在打滑现象。 3首先设定移动机器人的几个不同坐标系,推导不同坐标系间的变换关系进而求轮体雅可比矩阵,并求出运动学问题的正逆问题最小二乘解。在运动学基础上,求轮体复合系统在固定

32、坐标系中的加速度及加速度能,并求出动力学正逆问题解,为全方位移动机器人的进一步研究提供理论模型 7。11图 5 山茶采摘平台移动底盘Fig 5 Molile chassis of the camellia picking platform3.1.2 一种山地行走系统用全向履带行走系统可分为轮式和履带式两大类。轮式行走装置的特点是功耗低,较机动,但是通过性能比履带式差;履带式的特点则是与地面接触面积大,通过能力强,且履带式行走装置可利用履带的差速实现转弯,转弯半径小,甚至是原地转弯。但目前履带行走装置在使用的过程中存在两个较严重的缺点:一是转向时由于与地面接触面积大摩擦力大,所以功率消耗大,零件

33、易磨损;二是在改变运动方向时需要调整履带的朝向,增加了操作的复杂性。此处已删除12int main(void) /主函数 int i = 100;SystemInit(); /初始化系统,包括选择系统时钟频率。GPIO_Init_function( );do GPIO_SetBits(GPIOE, GPIO_Pin_0);/ 高delay_us(500); GPIO_ResetBits(GPIOE, GPIO_Pin_0); /低 delay_us(500); while(i-);但是这种软件 PWM 的方式将占用大量的 CPU 资源,使得 CPU 在处理其他事件的时候有明显的性能下滑现象。5

34、.2.2 硬件生成 PWM硬件的 PWM 产生是由 ARM 的事件管理器中自带的定时器来控制,如下图定时器开始后会不停的计数,从 0 加到最大值后返回 0 继续计数,计数器增加的快慢由定时器分频器的值来决定,它把 CPU 的时钟频率分频后使计数器的累加加快或减慢。这时我们设定一个比较值与之匹配,当计数器累加到这个值时就自动递减,递减到 0后重复前面操作。当相应的 IO 口被设定为使用硬件功能时我们设定其电平跳变寄存器,让这个 IO 口在计数匹配时电压自动跳变:(1) 由高到底(2)由低到高。这样就可以得到一个可以调整频率的脉冲信号 18。13图 16 定时器中断Fig.16 Timer int

35、errupt下面为PWM硬件功能的具体操作,我们设置了STM32硬件功能口定时器4发出一个频率为1K的脉冲:void TIM4_Configuration(unsigned int PWM1_Val)TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;TIM_OCInitTypeDef TIM_OCInitStructure;GPIO_InitTypeDef GPIO_InitStructure;RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);RCC_APB2PeriphClockCmd(RCC_A

36、PB2Periph_GPIOB, ENABLE);TIM_TimeBaseStructure.TIM_Period = 60000;/TIM_Period=24000/计数器向上计数到 65535 后产生更新事件,计数值归零TIM_TimeBaseStructure.TIM_Prescaler = 2; /设置预分频器分频系数 0TIM_TimeBaseStructure.TIM_ClockDivision = 0;/设置了时钟分割 TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;/TIM_CounterMode_Cente

37、rAligned1;/选择向上计数TIM_TimeBaseStructure.TIM_RepetitionCounter = 0;TIM_TimeBaseInit(TIM4,TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2 ;/定时模式TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;/输出使能14TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_Low;/TIM 输出极性TIM_OCInitStructure.TIM_P

38、ulse = PWM1_Val;/比较数 TIM_OC1Init(TIM4, /初始化 GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 ; /OC1GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOB, int main(void)SystemInit();TIM4_Configuration(12000);TIM4_Cmd();while(1);这样做的好处是节约了大量的 CPU 资源,可

39、以使用这些资源做其他的操作和判断,从而提高了 CPU 的效率。6 系统调试在本此设计当中本人充分考虑了实用的要求、实验室条件和经济性,旨在设计一款能减轻人工劳动强度和提高工作效率要求,价格适中,操作方便的产品。突出表现在一下几点:(1)精确性 底盘自身的精确性很好,升降动作定位精准;采用编码盘定位技术,使得采摘机器人的自动行走和定点停车可以很准确不会有严重的偏移。(2)创新性 这台智能可升降移动平台是在以往的各类平台的基础上的创新,所以以前是没有这种设计的,完全是自主研究设计制作和实验。7 总 结通过这次的毕业设计,使我的大学生活更加充实。三年来大部分的课余时间包括寒暑假都是在实验室度过的,在

40、这个小小的实验室里,汇集了全校机器人机械电子方面的爱好者,通过交流相互学习,共同进步。实验室生活极大的提高我的动手能力,还能独立设计制作比赛机器人;也提高了我收集利用资料的能力,因为我们设计中会遇到很多技术难关,单凭课堂上学的知识很难解决,只有询问老师,查看有关书籍,15或者在网络上寻找资料。山茶采摘平台(采摘机器人)涉及到机械原理、机械设计、特种加工、电子技术、微机控制、接口技术、传感测试技术、程序编写及调试等多方面的知识,锻炼综合应用能力,在设计时自学了大量的技术资料,充实了自己。参考文献1 冈本嗣男. 生物农业智能机器人M. 北京: 科学技术文献出版社, 19942 冯建农. 柳明. 自

41、主移动机器人智能导航研究进展J . 机器人, 1997, 19 (6) : 468-478.3 方建军. 采摘机器人开放式控制系统设计J. 农业机械学报, 2005, 36 (5) : 83-86.4 Patrick F.Muir and Charles P. Neuman. Kinematic Modeling For Feedback Control Of An Omnidirectional wheeled Mobile RobotJ. CH2413-3/87/0000/1772S01.00c1987 IEEE, PA 15213:177217785 Isik, Can. Meystel

42、, M.Alexander. Pilot Level of A Hierarchical Controller for An Unmanned Mobile Robot. IEEE Journal of RoboticsINT TEMP3 = 0;INT N0 = 0;INT N1 = 0;INT N2 = 0;INT N3 = 0;INT L1 ,L2,L;/* 文件名称: TIM/GPIO 初始化 */18#INCLUDE “STM32F10X.H“/* 函数: 底盘定时器 1 初使化 * 参数: PWM 初始值* 说明: 注意中断 */VOID TIM1_PWM(UNSIGNED INT

43、 PWM1_VAL,UNSIGNED INT PWM2_VAL,UNSIGNED INT PWM3_VAL,UNSIGNED INT PWM4_VAL )VU16 CCR1_VAL = PWM1_VAL;VU16 CCR2_VAL = PWM2_VAL;VU16 CCR3_VAL = PWM3_VAL;VU16 CCR4_VAL = PWM4_VAL;TIM_TIMEBASEINITTYPEDEF TIM_TIMEBASESTRUCTURE;TIM_OCINITTYPEDEF TIM_OCINITSTRUCTURE;GPIO_INITTYPEDEF GPIO_INITSTRUCTURE;RCC

44、_APB2PERIPHCLOCKCMD(RCC_APB2PERIPH_GPIOA | RCC_APB2PERIPH_TIM1 | RCC_APB2PERIPH_AFIO, ENABLE); /RCC_APB2PERIPH_AFIOTIM_TIMEBASESTRUCTURE.TIM_PERIOD = 60000; /TIM_PERIOD=65535,计数器向上计数到 65535 后产生更新事件,计数值归零TIM_TIMEBASESTRUCTURE.TIM_PRESCALER = 2; /3 分频TIM_TIMEBASESTRUCTURE.TIM_CLOCKDIVISION = 0; /时钟分割

45、TIM_TIMEBASESTRUCTURE.TIM_COUNTERMODE = TIM_COUNTERMODE_UP;/选择向上计数TIM_TIMEBASESTRUCTURE.TIM_REPETITIONCOUNTER = 0;TIM_TIMEBASEINIT(TIM1, /根据TIM_TIMEBASEINITSTRUCT 中指定的参数初始化 TIMX TIM_OCINITSTRUCTURE.TIM_OCMODE = TIM_OCMODE_PWM2 ;/定时模式TIM_OCINITSTRUCTURE.TIM_OUTPUTSTATE = TIM_OUTPUTSTATE_ENABLE;/输出使能1

46、9TIM_OCINITSTRUCTURE.TIM_OCPOLARITY = TIM_OCPOLARITY_LOW;/TIM输出比较极性/输出引脚配置为推挽输出GPIO_INITSTRUCTURE.GPIO_PIN = GPIO_PIN_8 | GPIO_PIN_9 | GPIO_PIN_10 | GPIO_PIN_11;GPIO_INITSTRUCTURE.GPIO_MODE = GPIO_MODE_AF_PP;GPIO_INITSTRUCTURE.GPIO_SPEED = GPIO_SPEED_50MHZ; GPIO_INIT(GPIOA, TIM_OCINITSTRUCTURE.TIM_P

47、ULSE = CCR1_VAL;/比较数TIM_OC1INIT(TIM1, /初始化定时 1TIM_OCINITSTRUCTURE.TIM_PULSE = CCR2_VAL;TIM_OC2INIT(TIM1, /初始化定时 1TIM_OCINITSTRUCTURE.TIM_PULSE = CCR3_VAL;TIM_OC3INIT(TIM1, /初始化定时 1TIM_OCINITSTRUCTURE.TIM_PULSE = CCR4_VAL;TIM_OC4INIT(TIM1, /初始化定时 1TIM_CMD(TIM1, ENABLE);/使能定时器TIM_CTRLPWMOUTPUTS(TIM1,E

48、NABLE);/* 函数: GPIO 初始化 */VOID GPIO_CONFIGURATION(VOID)GPIO_INITTYPEDEF GPIO_INITSTRUCTURE;RCC_APB2PERIPHCLOCKCMD(RCC_APB2PERIPH_GPIOC |RCC_APB2PERIPH_GPIOD | RCC_APB2PERIPH_GPIOE | RCC_APB2PERIPH_AFIO, ENABLE);/按键20GPIO_INITSTRUCTURE.GPIO_PIN = GPIO_PIN_2 | GPIO_PIN_3;GPIO_INITSTRUCTURE.GPIO_MODE = GPIO_MODE_IPD;GPIO

本站链接:文库   一言   我酷   合作


客服QQ:2549714901微博号:道客多多官方知乎号:道客多多

经营许可证编号: 粤ICP备2021046453号世界地图

道客多多©版权所有2020-2025营业执照举报