Support a dynamic path resolution for each path segment

[mjansen4857]

Dynamically adjust the number of trajectory states per path segment based on the length of the segment. This should also allocate more segments to parts of the path that would require more resolution, such as areas where there are module rotation discontinuities. This could help further optimize the performance of #675