Fixing SlopedGrid collisions, adding unit tests, improved debugDraw