草庐IT

c++ - 如何检查 x-y 轴上的碰撞

coder 2024-02-23 原文

我正在 Ubuntu 中使用 C/C++ 编写移动机器人应用程序，目前，我正在使用激光传感器扫描环境并检测机器人移动时与物体的碰撞。

此激光器的扫描区域为 270°，最大半径为 4000 毫米。 它能够检测到此范围内的物体并报告它们与传感器的距离。

每个距离都在平面坐标中，因此为了获得更多可读数据，我将它们从平面坐标转换为笛卡尔坐标，然后将它们打印在文本文件中，然后在 MatLab 中绘制它们以查看激光检测到了什么。

这张图展示了笛卡尔坐标上的典型检测。 值以米为单位，因此 0.75 是 75 厘米，2 是两米。连续的蓝色点是所有检测到的对象，而 (0,0) 附近的点指的是激光位置，必须丢弃。由于激光扫描区域为 270°，因此会产生 y < 0="" 下的蓝点；="">我添加了红线方 block (1.5 x 2 米)以确定我想要实现碰撞检查的区域。 因此，我想实时检测该区域内是否有点(对象)，如果有，则调用一些函数。这有点棘手，因为此检查还应该能够检测是否有连续的点以确定对象是否真实(即它是否检测到一个点，那么它应该搜索最近的点来确定它们是否构成一个对象，或者它是否只是一个可能是检测错误的点。

这是我用来执行单次扫描的函数:

struct point pt[limit*URG_POINTS];
//..
 for(i = 0; i < limit; i++){
 for(j = 0; j < URG_POINTS; j++){
  ang2 = kDeg2Rad*((j*240/(double)URG_POINTS)-120);
  offset = 0.03;     //it depends on sensor module [m]

  dis = (double) dist[cnt] / 1000.0;
  //THRESHOLD of RANGE
  //      if(dis > MAX_RANGE) dis = 0;  //MAX RANGE = 4[m]
  //      if(dis < MIN_RANGE) dis = 0;
  pt[cnt].x = dis * cos(ang2) * cos(ang1) + (offset*sin(ang1)); // <-- X POINTS
  pt[cnt].y = dis * sin(ang2); // <-- Y POINTS
 // pt[cnt].z = dis * cos(ang2) * sin(ang1) - (offset*cos(ang1)); <- I disabled 3D mapping at the moment
  cnt++;
}
ang1 += diff;
}

每次扫描后，pt 包含 x-y 坐标中的所有检测点。

我想做这样的事情:

  • perform a single scan, then at the end,
  • apply collisions check on each pt.x and pt.y
  • if you find a point in the inner region, then check for other near points, if yes, stop the robot;
  • if not or if no other near points are found, start another scan

我想知道如何轻松检查先前定义区域内的对象(由多个单点组成)。

你能帮帮我吗？ 这对我来说似乎很难:(

最佳答案

我不认为我可以给出一个完整的答案，但有一些关于可能去哪里的想法。

实时是什么意思？运行任何给定算法可能需要多长时间？您的程序在什么处理器上运行？

只需检查 abs(x) < 0.75 是否可以过滤检测范围内的点即可。和 y< 2 && y > 0 .此外，您应该只考虑距离 0 足够远的点，因此 x^2 + y^2 > d . 但这应该是微不足道的部分。

更有趣的是，它将检测点组。 DBSCAN已被证明是一种用于检测二维点组的相当不错的聚类算法。这里的关键问题是 DBSCAN 是否足够快以用于实时应用程序。 如果不是，您可能需要考虑优化算法(您可以使用一些巧妙的索引结构将其复杂度压缩到 n*log(n))。

此外，可能值得考虑如何整合从上次迭代中获得的知识(假设频率很高，数据点的变化应该不会太大)。

可能值得研究其他机器人项目 - 我可以想象解释传感器数据以构建周围环境信息的问题是一个相当普遍的问题。

更新

在不知道您在什么地方应用 DBSCAN 解决您的问题的情况下，很难给您好的建议。但是，让我尝试逐步指导您如何使用算法:

  • 对于您收到的每个数据点，您检查它是否在您想要观察的区域中。 (我上面给出的条件应该有效)。
  • 如果数据点在区域内，则将其保存到某种列表中
  • 读取所有数据点后，检查列表是否为空。如果是这样，一切都很好。否则，我们必须检查是否有更大的数据点组需要您浏览。

现在是更困难的部分。您将 DBSCAN 放在这些点上并尝试查找点组。哪些参数适用于我不知道的算法 - 必须尝试。之后你应该有一些点簇。我不完全确定您将如何处理这些组 - 一个想法是检测每个组中在极坐标中具有最小和最大度数的点。这样你就可以决定你必须把你的车转多远。如果两个群体靠得太近以至于无法穿过两者之间的缝隙，则必须特别小心。

对于 DBSCAN 的实现，您可以 here或者只是向谷歌寻求帮助。这是一种相当常见的算法，已经被编码了数千次。为了进一步优化速度，创建自己的实现可能会有所帮助。但是，如果您发现其中一个实现似乎可用，我会先尝试一下，然后再完全自行实现。

如果您在实现算法时遇到了特定问题，我建议您创建一个新问题，因为它与这个问题相去甚远，您可能会得到更多愿意帮助您的人。

我希望现在事情变得更清楚了。如果不是，请给出您有疑问的确切点。

关于c++ - 如何检查 x-y 轴上的碰撞，我们在Stack Overflow上找到一个类似的问题： https://stackoverflow.com/questions/10460867/

amp43strong的sectionc++algorithmrobotics

有关c++ - 如何检查 x-y 轴上的碰撞的更多相关文章

  1. ruby - 如何使用 Nokogiri 的 xpath 和 at_xpath 方法 - 2

    我正在学习如何使用Nokogiri，根据这段代码我遇到了一些问题:require'rubygems'require'mechanize'post_agent=WWW::Mechanize.newpost_page=post_agent.get('http://www.vbulletin.org/forum/showthread.php?t=230708')puts"\nabsolutepathwithtbodygivesnil"putspost_page.parser.xpath('/html/body/div/div/div/div/div/table/tbody/tr/td/div

  2. ruby - 如何从 ruby​​ 中的字符串运行任意对象方法？ - 2

    总的来说，我对ruby​​还比较陌生，我正在为我正在创建的对象编写一些rspec测试用例。许多测试用例都非常基础，我只是想确保正确填充和返回值。我想知道是否有办法使用循环结构来执行此操作。不必为我要测试的每个方法都设置一个assertEquals。例如:describeitem,"TestingtheItem"doit"willhaveanullvaluetostart"doitem=Item.new#HereIcoulddotheitem.name.shouldbe_nil#thenIcoulddoitem.category.shouldbe_nilendend但我想要一些方法来使用

  3. python - 如何使用 Ruby 或 Python 创建一系列高音调和低音调的蜂鸣声？ - 2

    关闭。这个问题是opinion-based.它目前不接受答案。想要改进这个问题？更新问题，以便editingthispost可以用事实和引用来回答它.关闭4年前。Improvethisquestion我想在固定时间创建一系列低音和高音调的哔哔声。例如:在150毫秒时发出高音调的蜂鸣声在151毫秒时发出低音调的蜂鸣声200毫秒时发出低音调的蜂鸣声250毫秒的高音调蜂鸣声有没有办法在Ruby或Python中做到这一点？我真的不在乎输出编码是什么(.wav、.mp3、.ogg等等)，但我确实想创建一个输出文件。

  4. ruby-on-rails - 如何验证 update_all 是否实际在 Rails 中更新 - 2

    给定这段代码defcreate@upgrades=User.update_all(["role=?","upgraded"],:id=>params[:upgrade])redirect_toadmin_upgrades_path,:notice=>"Successfullyupgradeduser."end我如何在该操作中实际验证它们是否已保存或未重定向到适当的页面和消息？ 最佳答案 在Rails3中，update_all不返回任何有意义的信息，除了已更新的记录数(这可能取决于您的DBMS是否返回该信息)。http://ar.ru

  5. ruby-on-rails - 'compass watch' 是如何工作的/它是如何与 rails 一起使用的 - 2

    我在我的项目目录中完成了compasscreate.和compassinitrails。几个问题:我已将我的.sass文件放在public/stylesheets中。这是放置它们的正确位置吗？当我运行compasswatch时，它不会自动编译这些.sass文件。我必须手动指定文件:compasswatchpublic/stylesheets/myfile.sass等。如何让它自动运行？文件ie.css、print.css和screen.css已放在stylesheets/compiled。如何在编译后不让它们重新出现的情况下删除它们？我自己编译的.sass文件编译成compiled/t

  6. ruby - 如何将脚本文件的末尾读取为数据文件(Perl 或任何其他语言) - 2

    我正在寻找执行以下操作的正确语法(在Perl、Shell或Ruby中):#variabletoaccessthedatalinesappendedasafileEND_OF_SCRIPT_MARKERrawdatastartshereanditcontinues. 最佳答案 Perl用__DATA__做这个:#!/usr/bin/perlusestrict;usewarnings;while(){print;}__DATA__Texttoprintgoeshere 关于ruby-如何将脚

  7. ruby - 如何指定 Rack 处理程序 - 2

    Rackup通过Rack的默认处理程序成功运行任何Rack应用程序。例如:classRackAppdefcall(environment)['200',{'Content-Type'=>'text/html'},["Helloworld"]]endendrunRackApp.new但是当最后一行更改为使用Rack的内置CGI处理程序时，rackup给出“NoMethodErrorat/undefinedmethod`call'fornil:NilClass”:Rack::Handler::CGI.runRackApp.newRack的其他内置处理程序也提出了同样的反对意见。例如Rack

  8. ruby - 如何每月在 Heroku 运行一次 Scheduler 插件？ - 2

    在选择我想要运行操作的频率时，唯一的选项是“每天”、“每小时”和“每10分钟”。谢谢!我想为我的Rails3.1应用程序运行调度程序。 最佳答案 这不是一个优雅的解决方案，但您可以安排它每天运行，并在实际开始工作之前检查日期是否为当月的第一天。 关于ruby-如何每月在Heroku运行一次Scheduler插件？，我们在StackOverflow上找到一个类似的问题： https://stackoverflow.com/questions/8692687/

  9. ruby-on-rails - 如何从 format.xml 中删除 <hash></hash> - 2

    我有一个对象has_many应呈现为xml的子对象。这不是问题。我的问题是我创建了一个Hash包含此数据，就像解析器需要它一样。但是rails自动将整个文件包含在.........我需要摆脱type="array"和我该如何处理？我没有在文档中找到任何内容。 最佳答案 我遇到了同样的问题；这是我的XML:我在用这个:entries.to_xml将散列数据转换为XML，但这会将条目的数据包装到中所以我修改了:entries.to_xml(root:"Contacts")但这仍然将转换后的XML包装在“联系人”中，将我的XML代码修改为

  10. ruby - 检查 "command"的输出应该包含 NilClass 的意外崩溃 - 2

    为了将Cucumber用于命令行脚本，我按照提供的说明安装了arubagem。它在我的Gemfile中，我可以验证是否安装了正确的版本并且我已经包含了require'aruba/cucumber'在'features/env.rb'中为了确保它能正常工作，我写了以下场景:@announceScenario:Testingcucumber/arubaGivenablankslateThentheoutputfrom"ls-la"shouldcontain"drw"假设事情应该失败。它确实失败了，但失败的原因是错误的:@announceScenario:Testingcucumber/ar

随机推荐