Changes

Convert PSG mass constraints to hermite-simpson

The old constraints don't take into account throttle, so anything
less than maxthrottle was always using up just as much mass for
less thrust applied in vdot, which is always a bad trade.
 (commit: 9d796bd)