# Forward Kinematics Frame Simulation in MATLAB

I've worked out the T matrix of the tip (position and orientation) with respect to the base frame of a 6 DoF robot for 2 seconds at 1kHz.

So the size of the total T matrix is 4*4*1000.

How can I animate it with MATLAB? Just simple simulation showing the tip frame movement. Like this (not necessary showing the position in numbers):

from here

Thanks.

suppose you calculate the positions of your joints $$p_i, i=1\ldots6$$ using your homogeneous matrices.

The best solution in my experience is to plot the initial configuration e.g. like this:

// calc p for time t=0
f=figure(1);
plot3([0, p_1(1)], [0, p_1(2)], [0, p_1(3)]);
hold on;
plot3([p_1(1), p_2(1)], [p_1(2), p_2(2)], [p_1(3), p_2(3)])

// in a for loop i=1:length of you time vector