Pequeno refactor para organização do código
Incluindo opcao para debug, funcao de plot do robo agora desenha a direcao 'frente'