Refactored movement collsion detection

Still need to do it for enemies. Also need to normalize since right now
you go slower while going diagonal.