Updated the collision detection system for box/box
Got strictly convex QP solver working