Partial fix to wall hitting, still needs work. Commented code a bit better