Exemplo n.º 1
0
from pololu_controller import PololuController
from Servo import *
from data_structures import mini_arm as marm

utils = Utility()
alive = True

def quit():
	global alive
	alive = False

manager1 = SerialManager()
print 'Ports available'
manager1.list_ports()
print 'Select Dynamixel port'
user_input = utils.getch()

if manager1.open_port(user_input, 57600):
	
	serv_2 = Robotis_Servo(manager1, 1)
	print 'Setting up Dynamixel 2'
	
	print 'Dynamixel 2 at ' + str(serv_2.read_angle())

	while(alive):
		serv_2.move_angle(1, 1.5, blocking=False)
		time.sleep(1)
		serv_2.move_angle(2, 1.5, blocking=False)
		time.sleep(1)

manager1.close()
Exemplo n.º 2
0
from pololu_controller import PololuController
from Servo import *
from data_structures import mini_arm as marm

utils = Utility()
alive = True

def quit():
	global alive
	alive = False

manager1 = SerialManager()
print('Ports available')
manager1.list_ports()
print('Select Dynamixel port')
user_input = utils.getch()

if manager1.open_port(user_input, 115200):
	
	serv2 = Robotis_Servo(manager1,2)
	print('Setting up Dynamixel')
	print('Dynamixel angle at ' + str(serv2.read_angle()))
	print('Dynamixel encoder at ' + str(serv2.read_encoder()))

	serv5 = Robotis_Servo(manager1,5)
	print('Setting up Dynamixel')
	print('Dynamixel angle at ' + str(serv5.read_angle()))
	print('Dynamixel encoder at ' + str(serv5.read_encoder()))

	while(alive):
		#serv.move_angle(1, 1.5, blocking=False)