feat(trajectory): add TimeOptimalPathParameterization (M27) - #42

Check failure on line 325 in robotics/trajectory/TimeOptimalPathParameterization.hpp

sonarqubecloud / SonarCloud Code Analysis

Refactor this code to not nest more than 3 if|for|do|while|switch statements.

See more on https://sonarcloud.io/project/issues?id=embedded-pro_robotics-toolbox-cpp&issues=AaGwmI5H8qdaUkfzmdla&open=AaGwmI5H8qdaUkfzmdla&pullRequest=42