# 2连杆4关节机械臂正运动学计算结果错误如何解决

> 原文链接：https://robotics.hellobike.com/pitfalls/2025-10-05-robotics-se-117336
> 频道：pitfalls | 更新日期：2025-10-05 | 标签：auto, stackexchange, inverse-kinematics
> 核心摘要：开发者编写的2连杆4关节机械臂正运动学代码计算结果错误，修改平移矩阵第一行符号后解决

# 2连杆4关节机械臂正运动学计算结果错误如何解决

::: v-pre
> 本文由 AI 根据公开内容整理，可能有误，请以原文为准：[Forward kinematics for arm giving wrong results](https://robotics.stackexchange.com/questions/117336/forward-kinematics-for-arm-giving-wrong-results)（Robotics Stack Exchange #117336）

**状态**：已解决

## 问题

开发2连杆4关节机械臂的正运动学计算Python代码时，运行得到的计算结果不符合预期

## 环境

Linux / ROS 机器人软件与控制通用开发环境

## 解决办法

1. 将D12矩阵的第一行修改为`[-(a1*sin(q2))]`
2. 将D34矩阵的第一行修改为`[-(a2*sin(q4))]`

原问题作者：Pratham；采纳答案作者：Pratham。原内容依 CC BY-SA 4.0 授权，本页摘要同样依 CC BY-SA 4.0 授权。
:::

## 原始参考来源 (Sources)

- [Robotics Stack Exchange #117336：Forward kinematics for arm giving wrong results](https://robotics.stackexchange.com/questions/117336/forward-kinematics-for-arm-giving-wrong-results)