Include last point in downsampling

[MishkaMN]

PR Details

Description

Original issue is described well in the Github Issue.
Solution proposed here is to include the last point in the lanelet no matter the downsampling size, so that every lanelet's downsampling still has correct boundaries.
This would also fix cases where if lanelet is too small to be downsampled, it would still return at least 2 trajectory points which should be enough to fit spline.

Related GitHub Issue

usdot-fhwa-stol/carma-platform#2343

Related Jira Key

https://usdot-carma.atlassian.net/browse/CAR-6038

Motivation and Context

Discovered during VRU use case validation testing data analysis

How Has This Been Tested?

unit tested and integration testing on sim pc 1 in progress

Types of changes

• Defect fix (non-breaking change that fixes an issue)
• New feature (non-breaking change that adds functionality)
• Breaking change (fix or feature that cause existing functionality to change)

Checklist:

• I have added any new packages to the sonar-scanner.properties file
• My change requires a change to the documentation.
• I have updated the documentation accordingly.
• I have read the CONTRIBUTING document.
• I have added tests to cover my changes.
• All new and existing tests passed.

[sonarcloud]

Quality Gate passed

Issues
0 New issues
0 Accepted issues

Measures
0 Security Hotspots
No data about Coverage
0.0% Duplication on New Code

See analysis details on SonarCloud

[MishkaMN]

Currently I am trying to reproduce the error where I could meaningfully test this change.
And also make sure I am not breaking anything existing. I have other higher priority stories taking over that is pushing this behind a little bit

[MishkaMN]

This needs more integration testing as I see weird trajectory being generated from inlanecruising. Possibly due to overlapping points the spline fit is curving.

Dismissing review due to additional integration testing being required per Misheel's recent comment.