六轴机械臂正解FK和逆解IK算法

整理出了如下几个计算六轴机械臂正解和逆解的关键点： 01_机器人坐标系和关节的说明 02_算法坐标系的建立 03_D-H参数表的建立 04_FK（正解）算法 05_Matlab辅助计算FK（正解） 06_IK（逆解）算法 07_Matlab辅助计算IK（逆解） 文档中针对FK以及IK算法的推导均有详细的推导过程。希望各位能根据推导过程写出自己的代码。