Made changes to trajectory_generator code to separate translational
(from planner) and rotational (from control) trajectories
Cleaned lots of stuff