Diagonal Walls Collision Fix pt 1

We have started the fixing of the collision with diagonal walls. We ran
out of time so not much is there yet.