Fix plotting of cast hulls.
Add parsing support for belief-space initial trajectories. Change point.py to first do an optimization without collision costs, and then use the resulting trajectory to initialize the actual trajectory.