Unit collision 3

Works, but units can move off the map still. Need to look into why dis
is happening. Also, some errors exisit. I mark unit collision as buggy