from time import sleep
import getch
from core import Core as CORE
from autopilot import Autopilot as AUTOPILOT
from autopilot import MoveException,RightMoveException,LeftMoveException,ForwardMoveException
from random import randint
core=CORE();
#Enthaelt die Hilfe
def help():
	print("MOTION:")
	print("Forward:  w");
	print("Backward: s");
	print("Left:     a");
	print("Right:    d");
	print("Stop:     Space\n")
	print("GENERAL:")
	print("Help:	 h\n");
	print("MODE:")
	print("Automatisch:     q")
	print("Halbautomatisch: w")
	print("Manuell:         e")
def autopilot():
	try:
		core=AUTOPILOT()
		#core.start();
		while True:			
			try:	
				core.printValues();			
				if core.moveStatus!=1:			
					core.forward();
				else:
					core.statusTest();
			except ForwardMoveException:
				if randint(0,1):			
					core.backward();
				else:
					if randint(0,1):
						core.turnLeft();				
					else:
						core.turnRight();
			except LeftMoveException:
				core.turnLeft();
			except RightMoveException:
				core.turnRight();
			sleep(1);
	except KeyboardInterrupt:
		print("Verlasse Autopilot...")
		#core=CORE();
def doIt(order):
	switcher = {
        	'w': lambda: core.forward(),
        	's': lambda: core.backward(),
        	'd': lambda: core.turnRight(),
		'a': lambda: core.turnLeft(),
		' ': lambda: core.stop(),
		'i': lambda: core.printValues(),
		'h': lambda: help(),
		'q': lambda: autopilot(),
	}
	func = switcher.get(order, lambda: print("Der gewuenschte Befehl steht nicht zur Verfuegung"))
	return func();
print("Herzlich Willkommen im manuellen Controll-Interface!\n") 
try:	
	while True:
		input=getch.getch();
		print("Erinaco>>{0}".format(input))
		doIt(input);
except MoveException:
	print("Move Exception...")
except KeyboardInterrupt:
	print("Verlasse Erinaco...")
	core.__del__();