adds Trajectory message
adds new trajectory and nav ctrl messages
improves comments and adds more states for nav ctrl msgs
merging waypoint messages