feat: Implement module trajectory
feat: Implement module trajectory

Implement the basic functionaty of the module dealing with erros and output messages.
bit0001/trajectory_tracking,bit0001/trajectory_tracking