'LER': 2.18263145891,
'REY': -0.258485639687,
'LEY': 0.853785900783,
'RWY': 0.167101827676,
'LWY': -0.180156657963
}
for joint in torso:
Robot.move_limbs(joint, angle * torso[joint] * 0.0174533,
percent_max_speed)
def move_legs(angle, percent_max_speed=0.4):
legs = ['RKP', 'LKP']
for joint in legs:
Robot.move_limbs(joint, angle * 0.0174533, percent_max_speed)
while True:
key = raw_input("q = low cm\tw = torso in\n")
Robot.get_posture()
if key == "q":
Robot.set_posture('low_cm', 'current', 0.5)
print "Low cm\n"
elif key == "w":
Robot.set_posture('high_cm', 'current', 0.5)
print "High cm\n"
elif key == 'o':
Robot.set_posture('current')
else:
print "Unrecognised Key"
##########
times_GP = []
start_time_GP = time.time()
for i in range(10):
for j in range(100):
Robot.get_posture()
times_GP.append(time.time() - start_time_GP)
print "get posture done"
##########
#Set Posture timing test
##########
times_SP = []
start_time_SP = time.time()
for i in range(10):
for j in range(10):
Robot.set_posture('crunched', 'crunched')
times_SP.append(time.time() - start_time_SP)
print "set posture done"
##########
#Accelerometer timing test
##########
times_AC = []
start_time_AC = time.time()
for i in range(10):
for j in range(100):
Robot.get_acc('y')
times_AC.append(time.time() - start_time_AC)
print "accelerometer done"
pandas_data = {
'calls': calls,
