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.