Replaced wigen with custom matrix lib.

.gitmodules

src/lib/mathlib/math/Matrix.hpp

src/modules/commander/commander_helper.cpp

src/modules/controllib/blocks.cpp

src/modules/fw_pos_control_l1/mtecs/mTecs.cpp

src/modules/local_position_estimator/matrix/src/Matrix.hpp

src/modules/navigator/mission_block.cpp

src/platforms/px4_defines.h