Made a class to handle trajectory generation, still in progress
Minor changes that do not affect anything
Added publisher for informing about the size of the poses in the trajectory for pre-allocation of memory
Minor changes for publishing the size of trajectory in terms of poses