Print header in SCPgen
Added NMPC example from Albersmeyer2010
Disabled SCPgen linesearch until it has been fixed
Added minimal SCPgen example