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 “”)
  1. piecewise function of laserscan
![image.png center 544x172](https://cdn.nlark.com/yuque/0/2018/png/134562/1542280692169-d953a089-8fe6-48a7-b2cc-57c712b37c6b.png “”)
  1. 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
    1. Road surface segment, shown as line CD, is selected first. It always locates between two edgepoints nearest to center of the sensor.
    2. Curb lines, (BC and DE), are searchedsubsequently, based on point C and D determined fromthe former step.
    3. Rest segments are other features off the road.
  • monte-carlo localization with these features
    1. prediction with odom(easy part)
    2. 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 “”)
  1. resampling
    • curb-intersection measurement model
  2. LIDAR-VSA1 accumulate these curb point, and translate them to last coordinate
  3. LIDAR-VSA2 it’s just two parallel point, tagent to CD.And whenever at intersection, we get two these points

method2