Cleaned up nonlinearity.
Constraints 1,2 = linearized.
Constraint 3 = to be linearized.
Constraint 4 = nonlinear