More work towards planar collision

Doesn't work so far D:
Even more work towards planar collision

Works slightly more but still not