ddd

method1: BaoXing

ref: Curb-Intersection Feature Based Monte Carlo Localization on Urban Roads

• segmentation of laser scan

1. piecewise function of laserscan

1. use second-order differential filter to get local minimum-maximum detection point

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

1. resampling

• curb-intersection measurement model

1. LIDAR-VSA1
   accumulate these curb point, and translate them to last coordinate
2. LIDAR-VSA2
   it's just two parallel point, tagent to CD.And whenever at intersection, we get two these points

method2

转载于:https://www.cnblogs.com/jsrgfjz/p/9969687.html