It seems like you are trying to calculate the vector that points from the source point (Source x, y, z) to the fusion point (fusion x, y, z) at each time step, and then find the angles in the 3D space between these vectors as they change over time.
Firstly, the loop to create the vector can be avoided. In MATLAB we can directly subtract matrices. So, we can directly subtract source coordinates from fusion coordinated to get the vectors.
We can do something like this:
% After reading the matrices from “.csv” file
Sourcex = ViconStatic(1:421,3);
Sourcey = ViconStatic(1:421,4);
Sourcez = ViconStatic(1:421,5);
Fusionx = ViconStatic(1:421,6);
Fusiony = ViconStatic(1:421,7);
Fusionz = ViconStatic(1:421,8);
% Creating vectors from source to fusion
Vectorx = Fusionx - Sourcex;
Vectory = Fusiony - Sourcey;
Vectorz = Fusionz - Sourcez;
Now, once we have the vectors, we can calculate the angles between them using the dot product. The dot product of two vectors A and B is defined as “dot(A,B) = |A| * |B| * cos(theta)”, where “theta” is the angle between the vectors, and “|A|” and “|B|” are the magnitudes of the vectors “A” and “B” respectively.
We can calculate it as follows:
% Calculate the magnitude of each vector
Magnitude = sqrt(Vectorx.^2 + Vectory.^2 + Vectorz.^2);
% Normalize the vectors (make them unit vectors)
UnitVectorx = Vectorx ./ Magnitude;
UnitVectory = Vectory ./ Magnitude;
UnitVectorz = Vectorz ./ Magnitude;
% Calculate the dot product of consecutive vectors
% Initialize the angles array
angles = zeros(420, 1); % There will be one less angle than the number of time points
for i = 1:(length(UnitVectorx)-1)
dot_product = UnitVectorx(i) * UnitVectorx(i+1) + UnitVectory(i) * UnitVectory(i+1) + UnitVectorz(i) * UnitVectorz(i+1);
angles(i) = acos(dot_product);
end
% Convert angles from radians to degrees if needed
angles_degrees = rad2deg(angles);
Here, we are assuming that the angle is being calculated between the vector at one time point and the vector at next time point. If the angle was to be calculated with respect to a fixed reference vector, we would have to adjust the dot product accordingly.
