fixed some bugs on SetConstraints, Added the possibility of make a comparison between Explicit and Implicit MPC. Still debugging