机械原理/机构简图/机构运动学推导/Kmtool.pkg
曲柄滑块机构运动学，五杆机构运动学，七杆机构运动学
本文仅供学习使用，总结很多本现有讲述运动学或动力学书籍后的总结，从矢量的角度进行分析，方法比较传统，但更易理解，并且现有的看似抽象方法，两者本质上并无不同。
2024年底本人学位论文发表后方可摘抄
若有帮助请引用
本文参考：
《空间机构的分析与综合（上册）》-张启先，感谢张启先先生对机构学的卓越贡献，希望下册有见天明之日！
《高等机构学》-白师贤
《高等空间机构学》-黄真
《机构运动微分几何学分析与综合》-王德伦

食用方法
什么是杆组？——自行学习机械原理内容
理解为什么需要编写杆组程序——基本杆组自由度为0
杆组程序的好处——所有机构都可拆分杆组，无需从头推导闭环矢量方程
六杆机构是不是也很简单了？
三级杆组？四级杆组？你能编写么？
务必自己计算编写程序

---

1. RRR杆组

1.1 公式推导

1.1.1几何法

下述公式中的投影参数都是基于坐标系 { F } \left\{ F \right\} {F}进行描述的

已知杆组RRR两端回转副位置参数：$A:(x_A,y_A),C:(x_C,y_C)$ ，求解中间回转副B位置参数（要求B点位置存在——满足三角形存在条件）

其中，AC长为：$l_{AC}=\sqrt{(x_C-x_A{)}^2+(y_C-y_A{)}^2}$ ，且有：
$$\{\begin{array}{c}\phi =\mathrm{arc}\tan \left(\frac{z_C-z_A}{x_C-x_A}\right)\in (-\frac{\pi }{2},\frac{\pi }{2})\\ d=l_{AC}\\ {\alpha }_1=\mathrm{arc}\cos \left(\frac{{l_{AB}}^2+{l_{AC}}^2-{l_{BC}}^2}{2l_{AB}{l}_{AC}}\right)\in (0,\pi )\\ {\alpha }_2=\mathrm{arc}\cos \left(\frac{{l_{AB}}^2+{l_{BC}}^2-{l_{AC}}^2}{2l_{AB}{l}_{BC}}\right)\in (0,\pi )\\ {\alpha }_3=\mathrm{arc}\cos \left(\frac{{l_{AC}}^2+{l_{BC}}^2-{l_{AB}}^2}{2l_{AC}{l}_{BC}}\right)\in (0,\pi )\end{array}$$
建立闭环矢量方程：${\vec{R}}_{FA}+{\vec{l}}_{AB}+{\vec{l}}_{BC}={\vec{R}}_{FC}$ ，向固定坐标系基矢量投影，可得：
$$\{\begin{array}{l}{\hat{i}}^f:x_A+l_{AB}\cos {\theta }_A+l_{BC}\cos {\theta }_B=x_C\\ {\hat{j}}^f:y_A+l_{AB}\sin {\theta }_A+l_{BC}\sin {\theta }_B=y_C\end{array}$$
其中，位置参数$A:(x_A,y_A),C:(x_C,y_C)$已知 ，杆长$l_{AB},l_{BC}$已知，求解可得：
$${\theta }_{A1}=\{\begin{array}{c}\phi +{\alpha }_1(x_C-x_A\ge 0)\\ \phi +{\alpha }_1+\pi (x_C-x_A\le 0)\end{array},{\theta }_{A2}=\{\begin{array}{c}\phi -{\alpha }_1(x_C-x_A\ge 0)\\ \phi -{\alpha }_1+\pi (x_C-x_A\le 0)\end{array}$$
$${\theta }_{B1}={\theta }_{A1}-\pi +{\alpha }_2,{\theta }_{B2}={\theta }_{A2}-\pi -{\alpha }_2$$
则B点坐标为：$(x_A+l_{AB}\cos {\theta }_A,y_A+l_{AB}\sin {\theta }_A)$ 。

• 构件运动参数：
  将闭环矢量方程对时间 $t$ 求导：