Moving forward with unit tests
Improving test coverage for rml trajectory generation