Playing with mpc

I wanted to play with a few mpc-style examples early to shake out the interface.  it's pretty satisfying (albeit slow).  here are a bunch of small fixes, nips and tucks, and updated interfaces to support those tests.
The utraj part is duplicated from the parent class. Actually why don't we have two separate method `reconstructControlTrajectory` and `reconstructStateTrajectory`