def get_angles(pos): angles = inverse_kinematics.leg_ik(pos[0], pos[1], pos[2]) return [angles.posx, angles.posy, angles.posz]
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 ]