Finally got the polygon SAT working.