正逆运动学解（三维）

最新推荐文章于 2024-07-16 21:28:33 发布

可乐韭菜

最新推荐文章于 2024-07-16 21:28:33 发布

阅读量4.1k

点赞数 2

本文链接：https://blog.csdn.net/m0_46139849/article/details/105031454

版权

这篇博客介绍了如何在三维坐标下进行机器人正逆运动学的计算。首先讲解了正运动学，通过建立坐标系并给出计算公式，然后转换为程序实现。接着探讨了逆运动学的算法，虽然比正运动学更复杂，但也提供了相应的程序实现。

摘要由CSDN通过智能技术生成

我又来了！之前写了一个在二维直角坐标下的正逆运动学解今天写一下在三维坐标下如何进行正逆运动学的计算及程序实现。
一、正运动学
首先还是要建立一个坐标系，依然以机械臂举例，这里放一个正视图和一个俯视图。
在这里插入图片描述

正运动学：已知α、β、γ求C点坐标
咱们废话不多说了直接上公式
先求出AEAE=L2cos(α)+L3cos(β)
然后是X坐标X=AEcos(γ)
Y轴Y=AEsin(γ)
最后Z轴Z=L2sin(α)-L3sin(β)
转换成程序实现

#include<math.h>
#include<stdio.h>
float Alpha,Beta,Gamma,AE,L2,L3;
struct ForwardKinematics
{
   
	float x;
	float y;
	float z;
}h;
void main()
{
   
	AE=L2*cos(Alpha)+L3