We have two major vector loops: Top 6 Vectors Loop and Bottom 5 Vectors Loop.
Both 3 Vectors Loop are used to find the positions, velocity, and acceleration that we need to carry out the above two major vector loops.
These systems of equations are solved by MATLAB solver functions.