% 《机器人技术与应用》D-H 参数标定实验程序
clear;
close all;
t1 = tic;
% 读取数据
EEvalue = importdata('./MeasureData/EndValue.txt');
EEbasematrix = importdata('./MeasureData/BaseValue.txt');
EEthetaValue = importdata('./MeasureData/AngleValue.txt');
% 去除含有 NaN 的行
EEvalue.data(any(isnan(EEvalue.data),2),:) = [];
EEbasematrix.data(any(isnan(EEbasematrix.data),2),:) = [];
% theta 化为弧度
EEthetaValue = EEthetaValue * (pi / 180);
% 进行平面，圆，点的分裂处理
DataSize = size(EEthetaValue,1);
planeEE = zeros(DataSize,6);
circleEE = zeros(DataSize,6);
pointEE = zeros(DataSize,6);
for j = 1:DataSize
circleEE(j,:) = EEvalue.data(3*j-2,1:6);
planeEE(j,:) = EEvalue.data(3*j-1,1:6);
pointEE(j,:) = EEvalue.data(3*j,1:6);
end
% 测量坐标系下，机器人基坐标系 Tm_b
pm_b = EEbasematrix.data(2,1:3)';
zm_b = EEbasematrix.data(1,4:6)';
ym_b = EEbasematrix.data(3,4:6)'; %因为不知道 Y 轴是怎么测的。所以需要尝试。
xm_b = cross(ym_b,zm_b);
Tm_b = [xm_b, ym_b, zm_b, pm_b;
0, 0, 0, 1];
DH_nominal = [0, 338, -pi/2, 0;
0, 0, pi/2, 0;
0, 420, -pi/2, 0;
0, 0, pi/2, 0;
0, 380, -pi/2, 0;
0, 0, pi/2, 0;
0, 160, 0, 0];
dDH = zeros(7,4);
qq_40507199
- 粉丝: 0
- 资源: 4
我的内容管理
收起
- 我的资源
快来上传第一个资源
我的收益 登录查看自己的收益
我的积分
登录查看自己的积分
我的C币
登录后查看C币余额
我的收藏 
我的下载 
下载帮助
会员权益专享
最新资源
- zigbee-cluster-library-specification
- JSBSim Reference Manual
- c++校园超市商品信息管理系统课程设计说明书(含源代码) (2).pdf
- 建筑供配电系统相关课件.pptx
- 企业管理规章制度及管理模式.doc
- vb打开摄像头.doc
- 云计算-可信计算中认证协议改进方案.pdf
- [详细完整版]单片机编程4.ppt
- c语言常用算法.pdf
- c++经典程序代码大全.pdf
- 单片机数字时钟资料.doc
- 11项目管理前沿1.0.pptx
- 基于ssm的“魅力”繁峙宣传网站的设计与实现论文.doc
- 智慧交通综合解决方案.pptx
- 建筑防潮设计-PowerPointPresentati.pptx
- SPC统计过程控制程序.pptx
资源上传下载、课程学习等过程中有任何疑问或建议，欢迎提出宝贵意见哦~我们会及时处理！
点击此处反馈
