Use existing msg types for traj points. (#4)

- Move from the custom structs to trajectory_msgs types.
- Waypoints can now have accelerations.

Closes #4