Implemented SAT

Separating of axis theorim is implemented but not working yet.
Still need to do some bugfixes.