×

Arduino在办公室地图上绘制汽车路线

消耗积分:0 | 格式:zip | 大小:0.05 MB | 2022-10-20

李桂兰

分享资料个

描述

演示

如果您是 Arduino 新手，您可以开始：

理念

主要想法是通过在基于网络的地图上绘制路线来控制基于步进电机的机器人，只需在移动屏幕上触摸您的手指，机器人就可以将您的货物运送到目的地。

在这个项目中，我制作了一辆不使用反馈传感器的简单汽车。因此，位置误差会随着时间的推移而累积。

这个项目可能会启发人们通过使用某种反馈传感器来纠正位置误差来制造一个完美的搬运机器人。如果与Dijkstra算法等路由算法结合使用会更方便。

接线

  • 在 Arduino 上堆叠 PHPoC Shield 或 PHPoC WiFi Shield
  • 在 PHPoC Shield 或 PHPoC WiFi Shield 上堆叠两个步进电机控制器 PES-2604
 
pYYBAGNPRCGAPJyLAACLimLKyLY108.jpg
 
  • 将步进电机连接到步进电机控制器 PES-2605 的接线端子
  • 双极步进电机
 
poYBAGNPRCSAXLzjAADPdIsje98850.png
 
  • 单极步进电机：有两种方法可以将单极步进电机连接到 PES-2605 的接线端子上。用户可以选择其中之一。
 
poYBAGNPRCaAejbJAAGvxzo2DlI302.png
 
  • 通过扩展板上的拨码开关为每个步进电机控制器设置扩展 ID 为 13 和 14。您可以参考下表设置扩展 ID。
 
pYYBAGNPRCiAaK8vAACDOlbPNpQ989.png
 
  • 将限位开关连接到两个步进电机控制器的数字输入端口的 SW#0
 
poYBAGNPRCuAMZWVAAEG6dVfy4g380.png
 

这个怎么运作

我们需要一张办公室地图的图像。地图的大小必须与实际大小具有相同的纵横比。

 
pYYBAGNPRC2ACKIXAADD7P9hzJc074.png
 

提示：如果是根据当时的地砖绘制的，绘制地图的纵横比会更准确。

地图图像被缩放以适合移动屏幕。当手指触摸基于网络的地图时：

- XY坐标（以像素为单位）重新缩放为图像的坐标，然后作为目标位置发送到Arduino。Arduino将像素坐标转换为真实坐标（以毫米为单位）。代码：

/* convert pixel to millimeter */targetX = (long)(targetX / RATIO_PIX_PER_MM);targetY = (long)(targetY / RATIO_PIX_PER_MM);

- Arduino 计算方向（旋转角度）和距离基于：当前位置、先前方向和目标位置代码：

/* calculate the rotating angle */vectorX  = targetX - preX;vectorY  = targetY - preY;dist = sqrt(vectorX * vectorX + vectorY * vectorY);vectorX /= dist;vectorY /= dist;cosinAngle = (preVectorX * vectorX + preVectorY * vectorY); /* based on dot product between two vectors */angle = acos(cosinAngle) * 180 / PI;

- Arduino 将旋转角度转换为电机必须移动的步数，并向步进电机控制器发送命令以移动电机。代码：

stepMove = (angle * TRACK) / ((FULL_STEP_ANGLE / stepMode) * WHEEL_RADIUS) / 2;dir = preVectorX * vectorY - preVectorY * vectorX; /* direction of rotation: clockwise or counter-clockwise */
 
pYYBAGNPRC-AbaD3AAA_CEBm8pg511.png
 

WHEEL_RADIUS 是车轮的半径。

- Arduino 将距离转换为电机必须移动的步数，并向步进电机控制器发送命令以移动电机。代码：

stepMove = dist / WHEEL_PERIMETER * (FULL_STEP_NUM * stepMode);targetStepRight += stepMove;targetStepLeft -= stepMove;

WHEEL_PERIMETER 是车轮的周长

限位开关

车头设有限位开关，使电机在遇到障碍物时自动停止。

汽车初始位置

初始位置是 Arduino 启动或重置时汽车的位置。它必须相同：真实位置（您放置汽车的位置）、Arduino 代码中的位置设置和 Web 用户界面代码

在我的设置中，我将汽车设置在位置（第 16 块砖，第 22 块砖）（见下图）

在 Arduino 代码中（第 54、55 行）

//初始位置preX = 16 * BRICK_REAL_WIDTH;preY = 22 * BRICK_REAL_HEIGHT;

在Web User Interface (line 47. 48)//初始位置//初始位置touchImageX = 16 * IMAGE_WIDTH / 25.0;touchImageY = 22 * IMAGE_HEIGHT / 34.0;

 
poYBAGNPRDKAPKiYAAB4rE84OeE521.jpg
 

源代码

Arduino代码

这是arduino代码，它在无限循环中运行

网络用户界面 - remote_car.php

remote_car.php 是一个包含 Web 用户界面的文件。它需要存储在 PHPoC [WiFi] Shield 上。为了将文件上传到 PHPoC [WiFi] Shield，请执行以下步骤：

如何

  • 为PHPoC shield或PHPoC WiFi shield配置网络信息
  • 安装PHPoC 库
  • 安装PHPoC 扩展库
  • 编译并上传代码到 Arduino
  • 上传网页用户界面到 PHPoC [WiFi] shield
  • 打开 Serial Monitor 并复制 PHPoC Shield 的 IP 地址
  • 通过 Web 浏览器访问 Web 用户界面：http:// ip_address_of_shield /remote_car.php
  • 在地图上按点位置控制汽车

 


下载并关注上传者 低至0.43元/天 开通VIP 免费下载

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

评论(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:'Arduino在办公室地图上绘制汽车路线',//标题 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);