集中检查连杆参数表、坐标系放置与矩阵乘法顺序,逐步展开每一节齐次变换和末端位姿。当前先完成参数入口和输出结构,符号及数值计算待接入。
TABLE
A_i
T_0_i
AUDIT
输出不仅给最终矩阵,还保留每一节变换和约定说明,便于定位“数值正确但坐标系不同”的问题。