- better pcd downsampling
- allow disabling wpt generation and checking
- adjust code to new vehicle geometry