PS2 Controller working in simulation. Added constraints