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).