ros nav_msgs/OccupancyGrid 显示错位,混乱

在项目想采用rosjava android_core 进行二次开发。初步分析代码,认为如果在上面开发,能极大减少我们的开发工作量。运行demo 看看地图展示的效果。

https://github.com/rosjava/android_core

branch:kinetic

运行应用 android_tutorial_map_viewer

在android 平板上是这样的效果:


2D地图出现错位,轮廓错乱,混乱的情况。没法用于导航了。

+ OccupancyGridLayer.java

-- 控制地图数据块显示排列顺序的是. 控制地图层缩放,平移,旋转的是

+ CameraControlLayer.java

-- 实现触摸事件行为

-- 传播平移,旋转,缩放事件

所以出现的问题需要详细分析OccupancyGridLayer.java,可能会找到答案。

1. 监听接受 nav_msgs.OccupancyGrid 消息

@Override

public void onStart(VisualizationView view, ConnectedNode connectedNode) {

super.onStart(view, connectedNode);

  previousGl =null;

  getSubscriber().addMessageListener(new MessageListener() {

@Override

    public void onNewMessage(nav_msgs.OccupancyGrid message) {

update(message);

    }

});

}

2. 为了绘制尺寸超出纹理最大尺寸的地图,我们将地图分割成多个块,并为每个块绘制一个纹理(直接翻译注释)

-- 块的相关属性有分辨率(决定物理转换关系,比如单位像素对应的0.05米),块的宽度,

-- 相对地图坐标系块的原点坐标

3. 把地图分辨率颜色值分为三类,分别表示可行走区域,不可行走区域,未知区域。

/**

* Color of occupied cells in the map.

*/

private static final int COLOR_OCCUPIED =0xff111111;

/**

* Color of free cells in the map.

*/

private static final int COLOR_FREE =0xffffffff;

/**

* Color of unknown cells in the map.

*/

private static final int COLOR_UNKNOWN =0xffdddddd;

4. private void update(nav_msgs.OccupancyGrid message) 方法会更新每一个图片块,初步怀疑是图片块原点坐标计算有问题

-- 根据图片的宽度,高度,计算可以划分多少图片块

-- 每个图片块初始化为相同的物理分辨率

-- 逐个计算基于地图坐标系下的图片块坐标原点,对比maven仓库中的 android_core:0.4 版本发现增加如下修正,地图显示就没有问题了。

for (int y =0; y < numTilesHigh; ++y) {

for (int x =0; x < numTilesWide; ++x) {

final int tileIndex = y * numTilesWide + x;

        tiles.get(tileIndex).setOrigin(origin.multiply(new Transform(new Vector3(x *

resolution * TextureBitmap.STRIDE,

            y * resolution * TextureBitmap.HEIGHT, 0.), Quaternion.identity())));

//        tiles.get(tileIndex).setStride(TextureBitmap.STRIDE);

//solution for tile has gap in bitmap!!! be carefull.

        if (x < numTilesWide -1) {

tiles.get(tileIndex).setStride(TextureBitmap.STRIDE);

        }else {

tiles.get(tileIndex).setStride(width % TextureBitmap.STRIDE);

        }

}

}

关键的地方在最后一个图片快的宽度处理,如果是最后一个图片块宽度更新为(width % TextureBitmap.STRIDE)

这样就没有问题了



总而言之在方法 private void update(nav_msgs.OccupancyGrid message)中根据第4小点说明添加如下代码

//solution for tile has gap in bitmap!!! be carefull.

if (x < numTilesWide -1) {

tiles.get(tileIndex).setStride(TextureBitmap.STRIDE);

}else {

tiles.get(tileIndex).setStride(width % TextureBitmap.STRIDE);

}

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 216,324评论 6 498
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 92,356评论 3 392
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 162,328评论 0 353
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 58,147评论 1 292
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 67,160评论 6 388
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,115评论 1 296
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 40,025评论 3 417
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 38,867评论 0 274
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,307评论 1 310
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 37,528评论 2 332
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 39,688评论 1 348
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,409评论 5 343
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 41,001评论 3 325
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,657评论 0 22
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 32,811评论 1 268
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 47,685评论 2 368
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,573评论 2 353