Shallow water: added parameter scaling
Added SCPgen class
Copied SCPgen implementation from shallow water example
Added note in SQPMethod, should be corrected in the next iteration