请问matlab有没有函数计算四杆机构的运动轨迹?

如附件图中这样的情况 要求p点轨迹 有什么思路？？？