#import time

#Definire Arduino + 6 Servo Brat
arduino = Runtime.createAndStart("arduino","Arduino")
AcapelaSpeech = Runtime.createAndStart("AcapelaSpeech","AcapelaSpeech")
Servo_0 = Runtime.createAndStart("Servo_0","Servo")
Servo_1 = Runtime.createAndStart("Servo_1","Servo")
Servo_2 = Runtime.createAndStart("Servo_2","Servo")
Servo_3 = Runtime.createAndStart("Servo_3","Servo")
Servo_4 = Runtime.createAndStart("Servo_4","Servo")
Servo_5 = Runtime.createAndStart("Servo_5","Servo")

#Functie ascultare si redare
ControlRobot = Runtime.createAndStart("ControlRobot","InMoov")
ControlRobot.startMouth() # Redare text
ControlRobot.startEar() # Ascultare text

Ascultare = ControlRobot.ear
Redare = ControlRobot.mouth

#Adaugare comanda pt pozitia Implicita
Ascultare.addCommand("Test","python","PozitieImplicita")
Ascultare.addCommand("Best","python","PozitieImplicita2")

#Confirmari comenzi
Ascultare.addComfirmations("yes")
Ascultare.addNegations("no")

#Setari Arduino
arduino.connect("COM3")
#Serial baudarate
#Port /user/TTYUSB01 etc.

#Asteapta 1 sec pt conectare
#time.sleep(1)

#Atasare Servo Pini Arduino
Servo_0.attach("arduino",3) #Pin 3
Servo_1.attach("arduino",5) #Pin 5
Servo_2.attach("arduino",6) #Pin 6
Servo_3.attach("arduino",9) #Pin 9
Servo_4.attach("arduino",10) #Pin 10
Servo_5.attach("arduino",11) #Pin 11

#Definire metode
def PozitieImplicita():
	Servo_0.moveTo(90)
	Servo_1.moveTo(90)
	Servo_2.moveTo(90)
	Servo_3.moveTo(90)
	Servo_4.moveTo(90)
	Servo_5.moveTo(90)

def PozitieImplicita2():
	Servo_0.moveTo(90)
	Servo_1.moveTo(90)
	Servo_2.moveTo(90)
	Servo_3.moveTo(90)
	Servo_4.moveTo(90)
	Servo_5.moveTo(30)
	Servo_5.moveTo(60)
	Servo_5.moveTo(90)
	Servo_5.moveTo(120)
  
#Exec
PozitieImplicita();
#time.sleep(5)
PozitieImplicita2()

# Pornire ascultare
Ascultare.startListening()