基于模糊控制的全位移平衡机器人设计_刘恒.pdf
《基于模糊控制的全位移平衡机器人设计_刘恒.pdf》由会员分享,可在线阅读,更多相关《基于模糊控制的全位移平衡机器人设计_刘恒.pdf(8页珍藏版)》请在咨信网上搜索。
1、测控技术2023 年第 42 卷第 7 期计算机与控制系统收稿日期:2022 04 16基金项目:山东省自然科学基金项目(Z2020MF093);山东省研究生教育优质课程(SDYKC20026);中石油重大科技合作项目(ZD2019-183-003)引用格式:刘恒,李哲,杨明辉,等 基于模糊控制的全位移平衡机器人设计 J 测控技术,2023,42(7):102 109LIU H,LI Z,YANG M H,et al Design of Full Displacement Balancing obot Based on Fuzzy Control J Measurement ControlTe
2、chnology,2023,42(7):102 109基于模糊控制的全位移平衡机器人设计刘恒,李哲*,杨明辉,邓晓刚,曹玉苹(中国石油大学(华东)控制科学与工程学院,山东 青岛266580)摘要:设计了一种模糊控制的四轮全位移平衡机器人,通过 SolidWorks 改进设计了基于麦克纳姆轮的全位移平衡底盘、双轴云台等机械结构。以 Altium Designer 为开发平台设计了 STM32F405 核心板主控,外设电路设计主要包括:ICM20948 传感器电路、CAN 通信差分电路等。使用 Simulink 对算法进行仿真验证,云台控制算法使用了串级 PID 控制,底盘通过 HI220 陀螺仪
3、传感器结合模糊控制算法实现平衡及运动。最终制作出了实体机器人并对模糊控制算法进行了验证,与传统 PID 算法相比,基于模糊控制的平衡机器人在响应速度、鲁棒性、稳定性等方面均有一定的提升。相比于传统四轮机器人,制作的平衡机器人能够更好地通过狭小的空间,对环境的适应性更强。关键词:模糊控制;视觉识别;全位移;平衡机器人中图分类号:TP242 6文献标志码:A文章编号:1000 8829(2023)07 0102 08doi:10 19708/j ckjs 2022 08 298Design of Full Displacement Balancing obot Based on Fuzzy Con
4、trolLIU Heng,LI Zhe*,YANG Minghui,DENG Xiaogang,CAO Yuping(College of Control Science and Engineering,China University of Petroleum(East China),Qingdao 266580,China)Abstract:A four-wheel full displacement balancing robot with fuzzy control is designed Through SolidWorks,mechanical structures such as
5、 full displacement balancing chassis and biaxial head are designed based on Mc-Nam wheel STM32F405 core board main control is designed with Altium Designer as the development plat-form,and the peripheral circuit design mainly includes:ICM20948 sensor circuit,CAN communication differ-ential circuit,e
6、tc Simulink is used to simulate and verify the algorithm,the gimbal control algorithm uses cas-cade PID control,and the chassis is balanced and kinematic by using the HI220 gyroscope sensor combinedwith fuzzy control algorithm Finally,a solid robot is produced and the fuzzy control algorithm is veri
7、fied Com-pared with the traditional PID algorithm,the balanced robot has certain improvement in response speed,robust-ness and stability Compared with the traditional four-wheel robot,the balancing robot can better pass throughthe small space and has stronger adaptability to the environmentKey words
8、:fuzzy control;visual recognition;full displacement;balanced robot随着世界经济和科技的高速发展以及人口数量的不断增多,人类对于各类资源的需求与日俱增,促使各国纷纷开始对未知风险的领域与地区进行资源的勘探与开发。与此同时,近年来频发的自然灾害与安全事故带给人们的血泪教训,也同样促使着人们加大关于应用型机器人的投入与发展。针对目前勘探工作与灾难事故救援中所具有的复杂性、紧迫性和危险性的问题,基于模糊控制的全位移201平衡机器人应用于未知环境下的探测工作与灾难事故救援时,可以有效地缓解工作中时间紧、危险性大等问题,还能克服人类无法逾越
9、的障碍,保障人们的生命财产安全,减少损失1。随着嵌入式以及智能控制的发展,双轮自平衡机器人已经在许多领域开展研究和投入使用2。传统的两轮机器人可以实现前进、后退、转弯等常规运动,能够满足人们的日常需求。但在勘探救援等工作中,会面临众多复杂狭小的地形。双轮机器人的体积较小且转弯半径小,使得其运动更加灵活3。这类机器人在静态下是个典型的不稳定结构,具有非线性、不确定性和强耦合性的特点4,必须实时依靠双轮移动来保持平衡5。笔者所设计的四轮平衡机器人可以有效地解决这个问题,实现平移功能,并且通过缩小机器人的整体体积,从而增加机器人的可应用场景。移动机器人运动控制系统通常包含两部分内容:一是完成所需的控
10、制功能和算法的定义;二是这些功能在硬件和软件上的实现6 7。运动控制系统精度是衡量机器人性能的重要指标之一8,传统自平衡机器人的控制算法一般采用传统的 PID 控制、滑模(SlidingMode)控制、状态反馈极点配置控制器和模糊控制等9 10,模糊控制的基本思想最早是由 Zadeh 和Mamdani11 12 提出的,本设计使用了模糊控制 PID 改进算法,使得机器人在起伏等复杂环境中能够拥有较强的适应性及鲁棒性。1机械系统设计1 1底盘设计目前常用的轮式机器人驱动方式有:麦克纳姆轮式机器人、全轮偏转式移动机器人和球轮式移动机器人13 14。笔者采用四同轴心麦克纳姆轮设计,在具有原地转向和水
11、平移动功能的基础上,还具有速度快、结构稳定、负载能力强、维护简单等优点。为进一步缩小机器人整体尺寸,根据麦克纳姆轮运动分析,采用交叉布置、同步带传动方式。为确保底盘结构具有充足的鲁棒性、稳定性,使机器人能够适应多种复杂路况,结合实际成本、材料强度以及设计水平和实现难度等因素,悬挂机构采用垂直悬挂。根据平衡机器人的特点,采用大扭矩电机和同步带驱动的连杆组设计,保证了机器人在倒地后具有自救能力,以适应复杂、恶劣工况下的任务要求。机器人底盘机械设计如图 1 所示。基于麦克纳姆轮的全向移动机器人能实现前进、横移、360零半径旋转等基本运动和复合运动15。传统麦克纳姆轮的安装方向分为互为镜像关系的 A
12、轮与 B 轮。当麦轮正向旋转时,由速度的正向分解,A 轮图 1机器人底盘机械设计可分解为沿轴向左与垂直于轴向的前向速度分量;B轮可分解为沿轴向右与垂直于轴向的前向速度分量。据此结构可以实现平移功能。传统结构麦轮组合示意图如图 2 所示。图 2传统结构麦轮组合示意图平衡机器人的底盘根据传统麦克纳姆轮的结构进行改进,使其在减小整体体积的同时兼具灵活性和稳定性。改进设计的平衡机器人麦克纳姆轮底盘如图 3所示。图 3改进设计的平衡机器人麦克纳姆轮底盘图 4 为平衡机器人通过狭小环境示意图,相比于传统四轮机器人,本文设计的机器人能够更好地通过狭小空间,适应性更强。图 4机器人通过狭小环境示意图301基于
13、模糊控制的全位移平衡机器人设计1 2云台设计移动式云台的机械结构角度可随控制信号作用进行调整,为提高平台视觉系统在立体空间内的检测范围与精度效果,选取双轴移动式云台结构作为设计方案,双轴为俯仰(Pitch)轴和旋转(Yaw)轴。Pitch 轴采用电机直驱的方式进行驱动,Yaw 轴采用同步带进行传动,保证了控制的准确性。云台机械结构设计如图5 所示。图 5云台机械结构设计1 3仿真测试使用 Adams 对机器人自救机构进行仿真,计算电机需要的扭矩。根据整机的质量,对所需轮组电机扭矩进行计算。根据 Adams 进行悬挂分析,观察机器人的运动形态。机器人参数说明如表 1 所示。平衡机器人整体机械设计
14、示意图见图 6。表 1机器人参数说明项目规格/参数整体质量14kg整体高度0 3m整体垂直投影1m 0 8m麦克卡姆轮尺寸直径 1525mm,轮宽 45mm图 6平衡机器人整体机械设计示意图2机器人控制系统的硬件设计围绕 STM32F405 最小系统电路,依据机器人任务要求设计功能电路,主要包括:数字/模拟电路、外设功能电路、接口保护电路、电源转化电路、电源防反接与短路电路等。2 1电源模块设计硬件系统电源输入为24 V 电池,进行 LC 滤波后,进行并联分流处理,为底盘电机、云台电机及视觉模块等部分提供 24 V 电压电流。24 5 V(DC-DC)电路选择 MP2482 电源芯片,实现 2
15、4 5 V 的电源变换。3 3V 输出电源为所有电源电路中对信号波纹质量要求最高的部分。为保证硬件系统内所有 3 3 V 芯片高效、稳定地工作,本设计采用电路信号波纹稳定、结构相对简单的低压差线性稳压器(LDO)电源变换芯片MIC3975 实现 5 3 3 V(LDO)转换电路。2 2保护电路设计直流电源输入通常会给端口带来瞬时脉冲噪声。为了消除噪声对器件造成的损害。设计瞬态二极(TVS)和保护电路将瞬时电流从敏感器件引到地信号中。系统存在模电电源与数字电源两种电源分量,数字电源及信号中含有的高频分量会对模拟信号产生干扰、损害等影响。本设计使用 LC 低通滤波器,有效地将模电电源与数字电源进行
16、分离,保证系统数字电源与模拟电源之间互不干扰。2 3外设电路设计外设电路设计主要包括:ICM20948 传感器电路(如图7 所示)、CAN 通信差分电路(如图8 所示)、US-AT 接口电路、DEBUS 协议接收电路、PWM 控制电路、蜂鸣器报警电路、串行线调试(SWD)电路等。STM32F405 主控设计如图 9 所示。3机器人控制算法的设计3 1主程序逻辑框架主程序逻辑建立在 STM32 系统中断的基础上,防止各个模块任务之间的冲突,不同模块的任务拥有不同的优先级,如图 10 所示。最高优先级的任务为:遥图 7ICM20948 电路原理图401测控技术 2023 年第 42 卷第 7 期图
17、 8CAN 通信差分电路图 9STM32F405 主控设计图 10各任务优先级顺序控器数据接收;高优先级的任务为:CAN 以及 USAT等数据接收;次高优先级的任务为:底盘电机、云台电机以及各种数据处理;低优先级任务为:各模块初始化、看门狗、LCD 显示等。通过对不同任务的中断优先级的设计,使得任务能够稳定正常地运行,同时对遥控器的数据进行处理,使机器人在接收到不同的数据时做出对应的决策。在没有接收到遥控器指令时,能对自身的状态进行监控,主体程序流程图如图 11 所示。图 11主体程序流程图3 2云台算法设计云台等待遥控器发出信号,当收到遥控器信号之后,云台参数开始初始化,随后云台位置归中,当
18、云台归中任务完成后,云台给定值由遥控器发送,随后云台进入串级控制模式,云台控制逻辑如图 12 所示。图 12云台控制逻辑框图501基于模糊控制的全位移平衡机器人设计当云台初始化任务完成之后,云台 Pitch 轴的角度由遥控器给定,云台 Yaw 轴的角度由底盘给定,即云台 Yaw 轴跟随底盘旋转。云台外环反馈值是电机输出的速度值,内环反馈值是电机当前的角度值,构成速度环为主回路,角度环为内回路的串级 PID 控制器。云台 Pitch 轴串级控制如图 13 所示。图 13云台 Pitch 轴串级控制框图3 3底盘算法设计在现实平衡机器人的控制中,当平衡机器人受到不同的扰动时,机器人倾斜的角度与速度
19、不同,那么恢复所需的速度与加速度往往是不同的;同时机器人在自平衡和受干扰时所需要的条件不同,这就需要动态调整 PID 的参数,使机器人能够更好更快更稳地调整和保持姿态,而模糊控制刚好能够满足这一条件。3 3 1底盘整体控制逻辑设计经过改进的全位移平衡机器人的底盘,通过对平衡和位移运动的解耦,底盘上装有 HI220 陀螺仪传感器,可以实时测得底盘的倾斜角度和加速度,通过导电滑环和 CAN 通信与云台上的 STM32F405 进行通信,据此反馈在速度环和角度环串联之后由模糊控制的PID 形成平衡任务的算法,使得平衡机器人可以像传统麦克纳姆轮底盘一样,实现平移、旋转等多种运动。3 3 2模糊控制算法
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 模糊 控制 位移 平衡 机器人 设计 刘恒
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。