3D Matrix Multiplication using a Series

6 次查看(过去 30 天)
So I've got an issue in regards to multiplying out 3 4x4 matricies that i need to obtain my final transformation matrix. They're contained within a 4 x 4 x 3 matirx, as three distinct 4 x 4 "slices". The 3D matrix is probably the neatest way i can store the data, the numeric data is obained from a few arbitrary functions, for all intents and purposes, assume its just random numbers.
So i need to multiply them out to obtain "T" my overal transforation matrix, but for the sake of making my program more versatile I cant merely multiply out the slices. I need to do it as part of a series, say use N, for a 4 x 4 x N matrix. I.e. I kinda want my program to be universal.
Edit: I shouls add, it's required for the 4 x 4 matricies to be multiplied in order, i.e. Ast(:,:,n)*Ast(:,:,n+1)*...*Ast(:,:,n+m)
% 4 x 4 Homogeneous Translation Matricies
TransX = @(a)[1 0 0 a; 0 1 0 0; 0 0 1 0; 0 0 0 1];
TransY = @(b)[1 0 0 0; 0 1 0 b; 0 0 1 0; 0 0 0 1];
TransZ = @(c)[1 0 0 0; 0 1 0 0; 0 0 1 c; 0 0 0 1];
% 4 x 4 Homogeneous Rotational Matricies
RotX =@(theta)[1 0 0 0; 0 cos(theta) -sin(theta) 0; 0 sin(theta) cos(theta) 0; 0 0 0 1];
RotY =@(theta)[cos(theta) 0 sin(theta) 0; 0 1 0 0; -sin(theta) 0 cos(theta) 0; 0 0 0 1];
RotZ =@(theta)[cos(theta) -sin(theta) 0 0; sin(theta) cos(theta) 0 0; 0 0 1 0; 0 0 0 1];
%%%%%%%%%%%%%%%%%%%Physical System Parameters%%%%%%%%%%%%%%%%%%%%
%Link Numbers - Kinda Important for Making application more universal
n = 3;
%Denevit Hartenberg 'Table'
%User Can set these to whatever, but must be n entries
a= [2,3,4];
alpha = [0,0,0];
d = [0,0,0];
theta_l = [pi/12,pi/12,pi/12];
theta = cumsum(theta_l);
%Anonymous Numeric Denavit Hartenberg Function
A=@(a_i,alpha_i,d_i,theta_i)RotZ(theta_i)*TransZ(d_i)*TransX (a_i)*RotX(alpha_i);
A_i= @(i)A(a(i),alpha(i),d(i),theta(i));
%Create 4 x 4 x n 3D Transformation Matricies
for j = [1:1:n]
Ast(:,:,j)= A_i(j);
end
%Overall Transformation Matrix
T = Ast(:,:,1)*Ast(:,:,2)*Ast(:,:,3);

采纳的回答

Ameer Hamza
Ameer Hamza 2020-10-18
A for-loop might be the simpliest solution
A = rand(4,4,10);
n = 2;
m = 4;
A_result = eye(size(A,1));
for i = n:n+m
A_result = A_result*A(:,:,i);
end

更多回答(0 个)

类别

Help CenterFile Exchange 中查找有关 Calendar 的更多信息

产品


版本

R2020a

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!

Translated by