US 12,020,490 B2
Method and device for estimating position of networked vehicle based on independent non-uniform increment sampling
Qian Huang, Hangzhou (CN); Yongdong Zhu, Hangzhou (CN); and Zhifeng Zhao, Hangzhou (CN)
Assigned to ZHEJIANG LAB, Hangzhou (CN)
Filed by ZHEJIANG LAB, Zhejiang (CN)
Filed on Oct. 24, 2023, as Appl. No. 18/493,795.
Application 18/493,795 is a continuation of application No. PCT/CN2022/131000, filed on Nov. 10, 2022.
Claims priority of application No. 202210854127.4 (CN), filed on Jul. 20, 2022.
Prior Publication US 2024/0071099 A1, Feb. 29, 2024
Int. Cl. G06T 7/70 (2017.01); G06V 20/58 (2022.01)
CPC G06V 20/58 (2022.01) 8 Claims
OG exemplary drawing
 
1. A method for estimating a position of a networked vehicle based on independent non-uniform increment sampling, comprising:
step (1): acquiring a point cloud and an image data frame which are spatiotemporal aligned in real-time through a solid-state laser radar and a camera, segmenting all target instances in the image data frame, and defining an image region where a target instance whose advanced semantic category is a networked vehicle is located as an advanced semantic constraint region;
step (2): using an affine transformation matrix from the point cloud to the image data frame to map all point clouds in a point cloud frame to a corresponding image, retaining mapping points falling in the advanced semantic constraint region, and discarding mapping points falling in other regions;
step (3): for a networked vehicle target instance in the advanced semantic constraint region, collecting all mapping points falling within its instance region, dividing a plurality of depth intervals at equal intervals according to the depth values of the mapping points, and designing an independent non-uniform increment sampling method to perform independent increment sampling on each depth interval to generate virtual mapping points, wherein a sampling rate is set according to a point density of each depth interval, a higher sampling rate is set for a depth interval with a low point density, and a highest sampling number for each interval is limited, in such a manner that sparse and missing regions of the mapping points are partially filled, and invalid sampling is avoided; and
step (4): reversely mapping the virtual mapping points to an original point cloud space to merge the virtual mapping points with an original point cloud, and then detecting networked vehicle targets and its' center point coordinate by using the merged point cloud to generate position estimation information of the networked vehicle.