method1: BaoXing
ref: Curb-Intersection Feature Based Monte Carlo Localization on Urban Roads
- segmentation of laser scan
![image.png |
center |
647x450](https://cdn.nlark.com/yuque/0/2018/png/134562/1542274808431-2bdf085b-12c1-4e0e-b3ec-9e4f28d7f531.png “”) |
- piecewise function of laserscan
![image.png |
center |
544x172](https://cdn.nlark.com/yuque/0/2018/png/134562/1542280692169-d953a089-8fe6-48a7-b2cc-57c712b37c6b.png “”) |
- use second-order differential filter to get local minimum-maximum detection point
![image.png |
center |
582x200](https://cdn.nlark.com/yuque/0/2018/png/134562/1542280807987-af331f62-7e8d-415f-8ef0-a33f889f20cf.png “”) |
we can think this as, after discussion woth Peng, we believe it’s one-order differential function(the same in the picture, red curve):
- classification of the scan
- Road surface segment, shown as line CD, is selected first. It always locates between two edgepoints nearest to center of the sensor.
- Curb lines, (BC and DE), are searchedsubsequently, based on point C and D determined fromthe former step.
- Rest segments are other features off the road.
- monte-carlo localization with these features
- prediction with odom(easy part)
- correction with two kind of features
- curb point
- intersection point
![image.png |
center |
626x324](https://cdn.nlark.com/yuque/0/2018/png/134562/1542281566591-1dcf8a60-fe29-45b3-a889-89541057a48b.png “”) |
- resampling
- curb-intersection measurement model
- LIDAR-VSA1
accumulate these curb point, and translate them to last coordinate
- LIDAR-VSA2
it’s just two parallel point, tagent to CD.And whenever at intersection, we get two these points
method2