#!/usr/bin/python
import maestro
import threading
import time

class myThread (threading.Thread):
	def __init__(self, threadID, name, servo, position, maest_servo):
		threading.Thread.__init__(self)
		self.threadID = threadID
		self.name = name
#		self.servoName = servoName
		self.servo = servo
		self.position = position
		self.maest_servo = maest_servo
	def run(self):
		print "Starten: " + self.name
		print time.ctime(time.time())
		bewegen(self.name,self.servo,self.position,self.maest_servo)
		print time.ctime(time.time())
		print "Beendet: " + self.name		

def bewegen(name,servo,position,maest_servo):
	maest_servo.setAccel(servo,1)
	maest_servo.setTarget(servo,position)


maest_servo = maestro.Controller()
thread1 = myThread(1,"oben",0,4 * 1600,maest_servo)
thread1.start()
thread2 = myThread(2,"links",1,4 * 1300,maest_servo)
thread2.start()
thread3 = myThread(3,"rechts",2,4 * 1400,maest_servo)
thread3.start()

threads = []
threads.append(thread1)
threads.append(thread2)
threads.append(thread3)
for t in threads:
	t.join()

maest_servo.close