from Kinematics by edward mebarak
Analyzes the kinematics of a 3-DOF robot.

[x1,y1,x2,y2,x3,y3,x4,y4,ax,ay,Vx,Vy,x_hc,y_hc,phi_hc]=square(x1,y1,x2,y2,x3,y3,x4,y4,i,phi_hFIX,check,ome,t,Tetha,np,incx,incy)
function [x1,y1,x2,y2,x3,y3,x4,y4,ax,ay,Vx,Vy,x_hc,y_hc,phi_hc]=square(x1,y1,x2,y2,x3,y3,x4,y4,i,phi_hFIX,check,ome,t,Tetha,np,incx,incy)
global  incx incy
if (i<=np/4)
    
    x_hc=x1;
    y_hc=y1;
    Vx=1;
    Vy=0;
    ax=.2;
    ay=0;
    x1=x1+incx;
elseif ((i>np/4)&(i<=np/2))
    
    x_hc=x2;
    y_hc=y1;
    Vx=0;
    Vy=1;
    ax=0;
    ay=0.2;
    y1=y1+incy;
elseif((i>np/2)&(i<=np*3/4))
    
    x_hc=x3;
    y_hc=y3;
    Vx=-1;
    Vy=0;
    ax=-.2;
    ay=0;
    x3=x3-incx;
elseif((i>np*3/4)&(i<=np+1))
    
    x_hc=x3;
    y_hc=y3;
    Vx=0;
    Vy=-1;
    ax=0;
    ay=-0.2;
    y3=y3-incy;
end

if (check==1)
    phi_hc=ome*t*57.29;
else
    phi_hc=phi_hFIX;
end

Contact us at files@mathworks.com