Implement narrow phase.

Judge separating axis, solve and update contact points.