Sunteți pe pagina 1din 1

function [q1,q2] = InversaManipulador2dof(x,y)

pi=3.1416;
L1=70;
L2=70;
h=(x^2+y^2)^(1/2)
alfa=atan2(y/x)*180/pi;
beta=acos((L1^2+h^2-L2^2)/(2*L1*h))*180/pi;
phi=asin(sin(beta)*h/L2)*180/pi;
q1=alfa+beta
q2=180-phi

S-ar putea să vă placă și