Fix: Changed output variables.
Pending: Linearizing constraint3. Maybe not possible?