Added maze solving and more

Added maze solving, refactored some shit, and fixed display offset.