manivela corredera invertida

clear , clc
resp=zeros(360,9);
vel=zeros(360,9);
% a=input('longitud de la manivela:');
% c=input('longitud del balancin :');
% d=input('longitud de la bancada: ');
% %alfa=input('el angulo alfa: ');
% %teta2=input('ingrese valor de teta2:');
% W2=input('velocidad angular del "a" :');
a=2;
d=6;
c=4;
W2=10;
teta1=0;
alfa=90;
for teta2=0:1:360

m=a*sind(teta2)*sind(alfa)+(a*cosd(teta2)-d)*cosd(alfa);
n=-a*sind(teta2)*cosd(alfa)+(a*cosd(teta2)-d)*sind(alfa);
l=-c*sind(alfa);
s=l-n;
t=2*m;
g=n+l;

x1 = (-t-sqrt(t^2-4*s*g))/(2*s);%comprobar signo
x2 = (-t+sqrt(t^2-4*s*g))/(2*s);%comprobar signo

teta41=atand(x1)*2;
teta42=atand(x2)*2;

teta31=teta41+alfa;
teta32=teta42-alfa;

b1=(a*sind(teta2)-c*sind(teta41))/sind(teta31);
b2=(a*sind(teta2)-c*sind(teta42))/sind(teta32);

% CALCULO DE VELOCIDAD

M=-a*W2*sind(teta2);
N=b1*sind(teta31)+c*sind(teta41);
O=a*W2*cosd(teta2);
P=b1*cosd(teta31)+c*cosd(teta41);
W4=(O*cosd(teta31)-M*sind(teta31))/(N*sind(teta31)+P*cosd(teta31));
B=(O-P*W4)/sind(teta31);
VAx=-a*W2*sind(teta2);
VAy=a*W2*cosd(teta2);
VBO4x=-c*W4*sind(teta41);
VBO4y=c*W4*cosd(teta41);
VA=sqrt(VAx.^2+VAy.^2);
VBO4=sqrt(VBO4x.^2+VBO4y.^2);

vel(teta2+1,1)=teta2;
vel(teta2+1,2)=W4;
vel(teta2+1,3)=B;
 vel(teta2+1,4)=VAx;
vel(teta2+1,5)=VAy;
vel(teta2+1,6)=VBO4x;
vel(teta2+1,7)=VBO4y;
vel(teta2+1,8)=VA;
vel(teta2+1,9)=VBO4;

end
disp(resp);
disp(vel);

subplot(3,1,1), plot(vel(:,1),vel(:,8), 'r'),title('grafico VA');

subplot(3,1,2), plot(vel(:,1),vel(:,9), 'r'),title('grafico VBO4');
subplot(3,1,3), plot(vel(:,1),vel(:,3), 'r'),title('grafico VBprima');

manivela balancin

clear , clc
resp=zeros(360,9);
VEL=zeros(360,10);
% a=input('longitud de la manivela:');
% b=input('longitud del acoplador:');
% c=input('longitud del balancin :');
% d=input('longitud de la bancada: ');
% p=input('Ingrese longitud p:');
% teta=input('ingrese teta p: ');
% W2=input('velocidad angular: ');
%teta2=input('ingrese valor de teta2:');
a=2;
b=7;
c=9;
d=6;
p=5;
teta=30;
W2=10;

teta1=0;
for teta2=0:1:360

m=d-a*cosd(teta2);
n=m^2+(a*sind(teta2))^2+c^2 ;
l=2*m*c;
q=2*a*sind(teta2)*c;
r=n-b^2;
u=r-l;
v=2*q;
g=r+l;

x1 = -(-v-sqrt(v^2-4*u*g))/(2*u);%comprobar signo
x2 = -(-v+sqrt(v^2-4*u*g))/(2*u);%comprobar signo

teta41=atand(x1)*2;
teta42=atand(x2)*2;
 teta31=acosd((c*cosd(teta41)-a*cosd(teta2)+d)/b);
teta32=acosd((c*cosd(teta42)-a*cosd(teta2)+d)/b);
% CALCULO DE VELOCIDAD

W3=((a*W2)/b)*((sind(teta42-teta2))/(sind(teta32-teta42)));
W4=((a*W2)/c)*((sind(teta2-teta32))/(sind(teta42-teta32)));

VAx=-a*W2*sind(teta2);
VAy=a*W2*cosd(teta2);

VBAx=-b*W3*sind(teta32);
VBAy=b*W3*cosd(teta32);

VBx=VAx+VBAx;
VBy=VAy+VBAy;

VPx=-p*W3*sind(teta+teta32)+VAx;
VPy=p*W3*cosd(teta+teta32)+VAy;
%ingresar valores a la matriz
VA=sqrt(VAx.^2+VAy.^2);
VB=sqrt(VBx.^2+VBy.^2);
VP=sqrt(VPx.^2+VPy.^2);

VEL(teta2+1,1)=teta2;
VEL(teta2+1,2)=W3;
VEL(teta2+1,3)=W4;
VEL(teta2+1,4)=VAx;
VEL(teta2+1,5)=VAy;
VEL(teta2+1,6)=VBAx;
VEL(teta2+1,7)=VBAy;
VEL(teta2+1,8)=VBx;
VEL(teta2+1,9)=VBy;
VEL(teta2+1,10)=VPx;
VEL(teta2+1,11)=VPy;
VEL(teta2+1,12)=VA;
VEL(teta2+1,13)=VB;
VEL(teta2+1,14)=VP;

end
disp(resp);

subplot(3,1,1), plot(VEL(:,1),VEL(:,12), 'r'),title('grafico VA');

subplot(3,1,2), plot(VEL(:,1),VEL(:,13), 'r'),title('grafico VB');
subplot(3,1,3), plot(VEL(:,1),VEL(:,14), 'r'),title('grafico VP');