%% 3R planar robot DIRECT KINEMATICS
% 07.2018, @Giuseppe Sensolini
clear all
clc
%% define symbolic variables
syms a alpha d theta
%% number of joint
N = 3;
%% DH table of parameters of 2R, same for each joint
% assign these parameters in order to compute specific values
% | a | alpha | d | theta |
DHTABLE = [ sym('a1') 0 0 sym('q1');
sym('a2') 0 0 sym('q2');
sym('a3') 0 0 sym('q3') ];
%% Build the general Denavit-Hartenberg trasformation matrix
TDH = [ cos(theta) -sin(theta) 0 a*cos(theta);
sin(theta) cos(theta) 0 a*sin(theta);
0 0 1 d;
0 0 0 1 ];
%% Build transformation matrices for each link
A = cell(1,N);
% For every row in 'DHTABLE' we substitute the right value inside
% the general DH matrix
for i = 1:N
a = DHTABLE(i,1);
alpha = DHTABLE(i,2);
d = DHTABLE(i,3);
theta = DHTABLE(i,4);
A{i} = subs(TDH);
end
%% Direct kinematics
disp('Direct kinematics of 2R robot in symbolic form')
disp(['Number of joints N = ',num2str(N)])
T = eye(4);
for i = 1:N
T = T*A{i};
T = simplify(T);
end
% output direct kinematics matrix
TOE = T
% output end-effector position
p = T(1:3,4)
% output xN axis
n = T(1:3,1)
% output yN axis
s = T(1:3,2)
% output zN axis
a = T(1:3,3)
%% end

DRobot
- 粉丝: 1048
- 资源: 250
最新资源
- 管家婆辉煌食品版TOP+13.11.zip
- 管家婆辉煌食品版TOP+13.02.zip
- 基于PSM算法的超声无损检测:Comsol模型参数化扫描与一键运行实践,基于PSM算法的超声无损检测:Comsol模型参数化扫描与一键运行实践,超声无损检测合成孔径PSM算法、对应comsol模型,效
- 管家婆辉煌食品版TOP12.9.zip
- gradle-7.6-bin.zip
- BTT与STT导弹六自由度Simulink完整模型及优化方案:涵盖总体设计与各模块数学模型,BTT与STT导弹六自由度Simulink完整模型及优化方案:涵盖总体设计与各模块数学模型,BTT导弹六自由
- 二阶多智能体系统固定时间一致性的优化策略,基于复杂网络的二阶多智能体系统在固定时间达成一致性的算法研究,二阶多智能体系统固定时间一致性 ,二阶多智能体系统; 固定时间一致性; 算法设计; 控制系统;
- 电力电子技术中基于新型变换器的动态电压恢复器(DVR)及其智能控制方法的模拟实现(论文复现含代码及详细说明)
- 异步电机控制:有速度传感器矢量控制算法的C代码与Simulink仿真模型实践,异步电机仿真控制:有速度传感器的矢量控制算法C代码及双闭环解耦Simulink仿真模型,异步电机有速度传感器矢量控制算法的
- 三相SVPWM整流器仿真与双闭环PI控制:电压外环与电流内环的讲解,输出电压调节至700V,单位功率因数运行及负载实验详解 ,三相SVPWM整流器仿真讲解:双闭环PI控制实现单位功率因数运行与负载实验
- 全耦合XFEM水力压裂程序:基于MATLAB的粘聚单元法与CZM(cohesive zone model)应用研究,基于全耦合XFEM的水力压裂模拟程序-通过Matlab实现粘聚单元法与CZM(co
- 无界鼠标,可以让两台电脑公用一套键鼠的小软件
- 河水溶解氧预测数据集,用于机器学习和预测应用
- MATLAB下的飞轮储能系统:三种控制模式下的充放电模型及无源与正负序分离PI策略构建,MATLAB环境下的飞轮储能充放电模型构建:控制模式详解及正负序分离PI策略研究,基于MATLAB搭建的飞轮储能
- VAR模型及拓展:从基础到前沿的时序分析方法研究与应用进展,基于VAR模型及拓展技术的深入解析与运用:包含TVP-VAR及各类VAR拓展模型的探究与应用,VAR模型及拓展 1.标准VAR模型:平稳性检
- 基于RS2指令的通讯例程:远程控制与设备互联的编程实践手册,3u RS2指令与打印机通信应用,全方位电脑远程协助与学习资料 附注:涉及外设通信和机器控制应用解决方案 ,3u 采用RS2指令与打印机通
资源上传下载、课程学习等过程中有任何疑问或建议,欢迎提出宝贵意见哦~我们会及时处理!
点击此处反馈


