'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,