从激光数据点中提取直线

要做回航充电,又不想加其他的传感器,只能靠lidar来识别充电桩的形状定位。

显然,充电桩表面是平整的直线,那么就要从那么多点中提取直线,然后再识别哪一条直线是充电桩。

提取直线就成为了最初的一步。

在github上找了半天找到一个像样的

https://github.com/kam3k/laser_line_extraction

试了一把,提取效果还不错。

记录一下并把配置说明一下:

topics

image.png

订阅的topic显然是 scan,发布了两个topic,我们要用的是/line_segments,/line_markers是用来在rviz上显示的,可以在launch中关闭。

配置

配置列表如下,基本上都好理解,被我分成了三大类,便于理解。

frame_id (default: "laser")  # The frame in which the line segments are published.
scan_topic (default: "scan")  # The LaserScan topic.
publish_markers (default: false) # Whether or not markers are published.

-----------------------------------------------------------------------------------------------------

bearing_std_dev (default: 0.001)  # The standard deviation of bearing uncertainty in the laser scans (rad).
least_sq_angle_thresh (default: 0.0001) # Change in angle (rad) threshold to stop iterating least squares (least_sq_radius_thresh must also be met).
least_sq_radius_thresh (default: 0.0001) # Change in radius (m) threshold to stop iterating least squares (least_sq_angle_thresh must also be met).
range_std_dev (default: 0.02) # The standard deviation of range uncertainty in the laser scans (m).

---------------------------------------------------------------------------------------------------------

max_line_gap (default: 0.4) # The maximum distance between two points in the same line (m).
min_line_length (default: 0.5) # Lines shorter than this are not published (m).
min_line_points (default: 9) # Lines with fewer points than this are not published.
min_range (default: 0.4) # Points closer than this are ignored (m).
min_split_dist (default: 0.05) # When performing "split" step of split and merge, a split between two points results when the two points are at least this far apart (m).
# 线段split的阈值,过大时很多线段被合并成一条,过小时,出现很多碎短的线段
outlier_dist (default: 0.05) # Points who are at least this distance from all their neighbours are considered outliers (m).

消息

最重要的是我们拿到 /line_segments的消息之后如何分析
消息类型是LineSegmentsList,如下,这不是主要的。

image.png

每个segment的类型LineSegment才是最主要的:

image.png

这其中的start, end都好理解:

  1. start 和end分别是这个线段的起点坐标和终点坐标

  2. radius和angle就不好理解了,于是我们echo了它的消息,如下

    radius: 0.752869129181
    angle: -0.797926008701
    covariance: [1.8016297644862789e-06, 1.2701141258730786e-06, 1.2701141258730786e-06, 9.006992058857577e-07]
    start: [-0.6120783090591431, -1.648557186126709]
    end: [-0.35934978723526, -1.402082920074463]
  - 
    radius: 1.1387783289
    angle: -0.808640360832
    covariance: [2.9355262540775584e-06, 2.777204372250708e-06, 2.777204372250708e-06, 2.649457655934384e-06]
    start: [-0.08191638439893723, -1.6525081396102905]
    end: [0.14225095510482788, -1.4385261535644531]
  - 
    radius: 1.12730681896
    angle: -0.787253201008
    covariance: [1.4751535672985483e-06, -2.180588808187167e-06, -2.180588808187167e-06, 3.510540864226641e-06]
    start: [1.011875033378601, -0.5831754803657532]
    end: [1.459415078163147, -0.1372928023338318]
  - 
    radius: 3.53375911713
    angle: 0.791161239147
    covariance: [3.9494702832598705e-06, -7.934396307973657e-06, -7.934396307973657e-06, 2.223481897090096e-05]
    start: [2.499594211578369, 2.497988224029541]
    end: [1.9661375284194946, 3.025331497192383]

我的地图总共拟合出4条直线,相应的结果如下,中间的frame是laser的frame,红色为x轴+,

image.png

按照ros中的坐标系来说,机器人正前方为0度,逆时针为正,激光数据的排列是从-135~135度(我的激光扫描范围是270度),那么上面4个线段从左往右依次是1,2,3,4。

这样的话我们就能理解 radius和angle的意思了。官方给的解释是极坐标下参数,我们能够理解到的是

angle: 原点到直线的垂线的角度,角度以机器人为坐标系计算,范围是-PI~PI
radius: 原点到直线的距离

根据这两个参数,完全不能确定什么,这两个参数完全能够根据start和end点计算出来。不理解这两个参数存在的意义。

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

推荐阅读更多精彩内容