Diagonal Movement

Changed from the print statements to actual movement. should work
flawlessly (I hope).