basic mazesolving fixed, needs finetuning