Adding trajectory library for testing purposes