Added general constraints, reordered code.
Added general constraints, reordered code.

 - constraints now must be fully specified. If there is no constraint, add inf.
 - plots now have a title, the X matrix is now transposed compared to last version.

wuyou33/MPCToolbox,ovidiualexandru/MPCToolbox