Text this: Constrained optimal control of linear and hybrid systems /