Added method to check if movement is ok

Also commented out non-working method.
A method needs to be made to handle choosing direction