plot trajectory
Merge branch 'decomp' of github.com:rll/lfd into decomp
added trajopt trajectory plotting as an argument