It resizes the matrix every time a new motion occurs and then goes back to the original size, and I've printed out here as an example the information matrix omega and in the vector C that I obtained, and I also printed out the final result. 