×

Magicbit的自平衡机器人

消耗积分:0 | 格式:zip | 大小:0.23 MB | 2022-11-24

王平

分享资料个

描述

嘿伙计们,今天在本教程中,我们将学习一些复杂的东西。那是关于使用 Magicbit 和 Arduino IDE 的自平衡机器人。所以让我们开始吧。

pYYBAGN-1UCAbxZoAATVUqxbM0A481.jpg
 

首先,让我们看看什么是自平衡机器人。自平衡机器人是两轮机器人。特殊之处在于机器人可以在不使用任何外部支撑的情况下自行平衡。通电后,机器人会站起来,然后通过摆动运动不断地保持平衡。所以现在你对自平衡机器人有了一些粗略的了解。

理论与方法论

为了平衡机器人,首先我们从某个传感器获取数据以测量机器人与垂直平面的角度。为此,我们使用了 MPU6050。从传感器获取数据后,我们计算垂直平面的倾斜度。如果机器人处于直线和平衡位置,则倾斜角为零。如果不是,则倾斜角为正值或负值。如果机器人向前倾斜,那么机器人应该向前移动。此外,如果机器人向反方向倾斜,则机器人应向反方向移动。如果这个倾斜角很高,那么响应速度应该很高。反之亦然,倾斜角低则反应速度应低。为了控制这个过程,我们使用了称为 PID 的特定定理。PID是用于控制许多过程的控制系统。PID 代表 3 个进程。

  • P-比例
  • I-积分
  • D-导数

每个系统都有输入和输出。同样这个控制系统也有一些输入。在这个控制系统中,即偏离稳定状态。我们称之为错误。在我们的机器人中,误差是垂直平面的倾斜角。如果机器人是平衡的,那么倾斜角为零。所以误差值将为零。因此PID系统的输出为零。该系统包括三个独立的数学过程。

  • 第一个是数字增益的乘法误差。这种增益通常称为 Kp。

P=误差*Kp

  • 第二个是在时域中生成误差的积分,并将其与一些增益相乘。这种增益称为 Ki

I = 积分(误差)* Ki

  • 第三个是时域误差的导数,并将其乘以一定量的增益。该增益称为 Kd

D=(d(误差)/dt)*kd

添加上述操作后,我们得到最终输出

输出=P+I+D

poYBAGN-1UWAETV1AAAWd5tIFhU773.png
 

因为P部分机器人可以得到与偏差成正比的稳定位置。我部分计算了误差与时间图的面积。所以它试图让机器人始终准确地稳定位置。D 部分测量时间与误差曲线的斜率。如果误差增加,则该值为正。如果误差在减小,则该值为负。因此,当机器人移动到稳定位置时,反应速度会降低,这将有助于消除不必要的超调。

PID 功能的输出限制在 0-255 范围(8 位 PWM 分辨率),并将作为 PWM 信号馈送到电机。

硬件设置

现在这是硬件设置部分。机器人的设计取决于你。当您设计机器人的身体时,您必须考虑它关于位于电机轴的垂直轴对称。电池组位于下方。因此机器人很容易平衡。在我们的设计中,我们将 Magicbit 板垂直固定在机身上。我们使用了两个 12V 齿轮电机。但是您可以使用任何类型的齿轮电机。这取决于您的机器人尺寸。

当我们讨论威廉希尔官方网站 时,它由 7.4V 锂电池供电。Magicbit 使用 5V 供电。因此我们使用 7805 稳压器将电池电压调节到 5V。在更高版本的 Magicbit 中,不需要该调节器。因为它的供电电压高达 12V。我们直接为电机驱动器提供 7.4V。

根据下图连接所有组件。

poYBAGN-1UeAEyTOAAD7J6aV4_M634.png
 

软件设置

在代码中,我们使用 PID 库来计算 PID 输出。

下载它的最新版本。

为了获得更好的传感器读数,我们使用了 DMP 库。DMP 代表数字运动过程。这是 MPU6050 的内置功能。该芯片集成了运动处理单元。所以需要阅读和分析。在它向微控制器(在本例中为 Magicbit(ESP32))生成无噪声准确输出之后。但是在微控制器方面有很多工作来获取读数并计算角度。简单来说,我们使用了 MPU6050 DMP 库。

要安装库,在 Arduino 菜单中转到工具-> 包含库->add.zip 库并选择您下载的库文件。

在代码中,您必须正确更改设定点角度。PID 常数值因机器人而异。因此,在调整时,首先将 Ki 和 Kd 值设置为零,然后增加 Kp,直到您获得更好的反应速度。更多的 Kp 会导致更多的过冲。然后增加 Kd 值。总是以很少的量增加它。该值通常低于其他值。现在增加 Ki 直到你有很好的稳定性。

选择正确的 COM 端口和板卡类型。上传代码。现在你可以玩你的 DIY 机器人了。


声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉

评论(0)
发评论

下载排行榜

全部0条评论

快来发表一下你的评论吧 !

'+ '

'+ '

'+ ''+ '
'+ ''+ ''+ '
'+ ''+ '' ); $.get('/article/vipdownload/aid/'+webid,function(data){ if(data.code ==5){ $(pop_this).attr('href',"/login/index.html"); return false } if(data.code == 2){ //跳转到VIP升级页面 window.location.href="//m.obk20.com/vip/index?aid=" + webid return false } //是会员 if (data.code > 0) { $('body').append(htmlSetNormalDownload); var getWidth=$("#poplayer").width(); $("#poplayer").css("margin-left","-"+getWidth/2+"px"); $('#tips').html(data.msg) $('.download_confirm').click(function(){ $('#dialog').remove(); }) } else { var down_url = $('#vipdownload').attr('data-url'); isBindAnalysisForm(pop_this, down_url, 1) } }); }); //是否开通VIP $.get('/article/vipdownload/aid/'+webid,function(data){ if(data.code == 2 || data.code ==5){ //跳转到VIP升级页面 $('#vipdownload>span').text("开通VIP 免费下载") return false }else{ // 待续费 if(data.code == 3) { vipExpiredInfo.ifVipExpired = true vipExpiredInfo.vipExpiredDate = data.data.endoftime } $('#vipdownload .icon-vip-tips').remove() $('#vipdownload>span').text("VIP免积分下载") } }); }).on("click",".download_cancel",function(){ $('#dialog').remove(); }) var setWeixinShare={};//定义默认的微信分享信息,页面如果要自定义分享,直接更改此变量即可 if(window.navigator.userAgent.toLowerCase().match(/MicroMessenger/i) == 'micromessenger'){ var d={ title:'Magicbit的自平衡机器人',//标题 desc:$('[name=description]').attr("content"), //描述 imgUrl:'https://'+location.host+'/static/images/ele-logo.png',// 分享图标,默认是logo link:'',//链接 type:'',// 分享类型,music、video或link,不填默认为link dataUrl:'',//如果type是music或video,则要提供数据链接,默认为空 success:'', // 用户确认分享后执行的回调函数 cancel:''// 用户取消分享后执行的回调函数 } setWeixinShare=$.extend(d,setWeixinShare); $.ajax({ url:"//www.obk20.com/app/wechat/index.php?s=Home/ShareConfig/index", data:"share_url="+encodeURIComponent(location.href)+"&format=jsonp&domain=m", type:'get', dataType:'jsonp', success:function(res){ if(res.status!="successed"){ return false; } $.getScript('https://res.wx.qq.com/open/js/jweixin-1.0.0.js',function(result,status){ if(status!="success"){ return false; } var getWxCfg=res.data; wx.config({ //debug: true, // 开启调试模式,调用的所有api的返回值会在客户端alert出来,若要查看传入的参数,可以在pc端打开,参数信息会通过log打出,仅在pc端时才会打印。 appId:getWxCfg.appId, // 必填,公众号的唯一标识 timestamp:getWxCfg.timestamp, // 必填,生成签名的时间戳 nonceStr:getWxCfg.nonceStr, // 必填,生成签名的随机串 signature:getWxCfg.signature,// 必填,签名,见附录1 jsApiList:['onMenuShareTimeline','onMenuShareAppMessage','onMenuShareQQ','onMenuShareWeibo','onMenuShareQZone'] // 必填,需要使用的JS接口列表,所有JS接口列表见附录2 }); wx.ready(function(){ //获取“分享到朋友圈”按钮点击状态及自定义分享内容接口 wx.onMenuShareTimeline({ title: setWeixinShare.title, // 分享标题 link: setWeixinShare.link, // 分享链接 imgUrl: setWeixinShare.imgUrl, // 分享图标 success: function () { setWeixinShare.success; // 用户确认分享后执行的回调函数 }, cancel: function () { setWeixinShare.cancel; // 用户取消分享后执行的回调函数 } }); //获取“分享给朋友”按钮点击状态及自定义分享内容接口 wx.onMenuShareAppMessage({ title: setWeixinShare.title, // 分享标题 desc: setWeixinShare.desc, // 分享描述 link: setWeixinShare.link, // 分享链接 imgUrl: setWeixinShare.imgUrl, // 分享图标 type: setWeixinShare.type, // 分享类型,music、video或link,不填默认为link dataUrl: setWeixinShare.dataUrl, // 如果type是music或video,则要提供数据链接,默认为空 success: function () { setWeixinShare.success; // 用户确认分享后执行的回调函数 }, cancel: function () { setWeixinShare.cancel; // 用户取消分享后执行的回调函数 } }); //获取“分享到QQ”按钮点击状态及自定义分享内容接口 wx.onMenuShareQQ({ title: setWeixinShare.title, // 分享标题 desc: setWeixinShare.desc, // 分享描述 link: setWeixinShare.link, // 分享链接 imgUrl: setWeixinShare.imgUrl, // 分享图标 success: function () { setWeixinShare.success; // 用户确认分享后执行的回调函数 }, cancel: function () { setWeixinShare.cancel; // 用户取消分享后执行的回调函数 } }); //获取“分享到腾讯微博”按钮点击状态及自定义分享内容接口 wx.onMenuShareWeibo({ title: setWeixinShare.title, // 分享标题 desc: setWeixinShare.desc, // 分享描述 link: setWeixinShare.link, // 分享链接 imgUrl: setWeixinShare.imgUrl, // 分享图标 success: function () { setWeixinShare.success; // 用户确认分享后执行的回调函数 }, cancel: function () { setWeixinShare.cancel; // 用户取消分享后执行的回调函数 } }); //获取“分享到QQ空间”按钮点击状态及自定义分享内容接口 wx.onMenuShareQZone({ title: setWeixinShare.title, // 分享标题 desc: setWeixinShare.desc, // 分享描述 link: setWeixinShare.link, // 分享链接 imgUrl: setWeixinShare.imgUrl, // 分享图标 success: function () { setWeixinShare.success; // 用户确认分享后执行的回调函数 }, cancel: function () { setWeixinShare.cancel; // 用户取消分享后执行的回调函数 } }); }); }); } }); } function openX_ad(posterid, htmlid, width, height) { if ($(htmlid).length > 0) { var randomnumber = Math.random(); var now_url = encodeURIComponent(window.location.href); var ga = document.createElement('iframe'); ga.src = 'https://www1.elecfans.com/www/delivery/myafr.php?target=_blank&cb=' + randomnumber + '&zoneid=' + posterid+'&prefer='+now_url; ga.width = width; ga.height = height; ga.frameBorder = 0; ga.scrolling = 'no'; var s = $(htmlid).append(ga); } } openX_ad(828, '#berry-300', 300, 250);