def get_angles(pos):
    angles = inverse_kinematics.leg_ik(pos[0], pos[1], pos[2])
    return [angles.posx, angles.posy, angles.posz]
Exemple #2
0
def moveLeg(leg, x, y, z, d=0.3):
    motors = [m.name for m in leg]
    print(leg)
    cmd = dict(zip(motors, leg_ik(x,y,z)))    
    robot.goto_position(cmd, d)
def get_angles (pos):
	angles = inverse_kinematics.leg_ik(pos[0], pos[1], pos[2])
	return [ angles.posx, angles.posy, angles.posz ]