position.m

利用matalb进行机械原理的仿真实验

%%%矩阵法对铰链四杆机构进行运动学分析,子函数用于求解角位移
function f=Position(x)

global l1 l2 l3 l4 th1 w1

f=[l2*cos(x(1))-l3*cos(x(2))-l4+l1*cos(th1)
    l2*sin(x(1))-l3*sin(x(2))+l1*sin(th1)];