我已经制作了一个由Arduino和Processing控制的机器人,它通过旋转自己(就像一个球体)在房间里移动。我需要的是,一旦它在地板上移动(假设在一个3m x 3m的房间内),就能够获得新的位置。我使用一个9自由度的传感器(3轴加速度计数据,3轴陀螺仪和3轴磁性数据)来确定它的滚动,俯仰和偏航以及它的方向。
如何在笛卡尔(x,y,z)坐标中准确识别机器人相对于其起始位置的位置?我不能使用GPS,因为每次旋转<em
我想实现Dijkstra算法,在这个3D接口中获得两个节点之间的最短路径。在此之前,我使用Dijkstra算法中的图形处理2D曲面。但这一次我坚持住了。寻找最终的解决方案。星节点是我的目标节点,其余的任何节点都可以是源节点。这些节点的位置由以下代码估计。go")
ax.set_ylabel('Y Label')
ax.set_zlabel('Z L