Fixed bug in move function that caused infinite loop. Still fixing bugs in move_to_door and move_to_teacher.
Rewrote move_to_teacher and move_to_door so that they now work. Fixed some formatting errors.