Belief control costs and constraints and plotting.

Add control costs and constraints.
Add python bindings for some belief costs and constraints.
Add plotting of 2d ellipse.
Add plotting for simulated covariance; plotted with dotted lines.
Add another way to define belief dynamics constraint (currently not being used).
Merge branch 'master' of github.com:alexlee-gk/trajopt