Update Matrix.hpp (#4966)
Update Matrix.hpp (#4966)

This was horribly wrong. Matrix is first cast into a matrix of size NxM (which is supposed to be the size of the result - NOT the starting point) so the transpose result becomes garbage. Instead make "Me" an MxN matrix as the original. Took me a whole evening to figure out this problem. Now my Kalman filter finally returns good results.
mcgill-robotics/Firmware,acfloria/Firmware,krbeverx/Firmware,darknight-007/Firmware,jlecoeur/Firmware,darknight-007/Firmware,Aerotenna/Firmware,dagar/Firmware,jlecoeur/Firmware,acfloria/Firmware,mcgill-robotics/Firmware,mje-nz/PX4-Firmware,darknight-007/Firmware,krbeverx/Firmware,PX4/Firmware,acfloria/Firmware,acfloria/Firmware,mcgill-robotics/Firmware,PX4/Firmware,krbeverx/Firmware,mcgill-robotics/Firmware,darknight-007/Firmware,PX4/Firmware,mje-nz/PX4-Firmware,dagar/Firmware,krbeverx/Firmware,Aerotenna/Firmware,Aerotenna/Firmware,mcgill-robotics/Firmware,Aerotenna/Firmware,jlecoeur/Firmware,mje-nz/PX4-Firmware,mcgill-robotics/Firmware,jlecoeur/Firmware,Aerotenna/Firmware,dagar/Firmware,Aerotenna/Firmware,mcgill-robotics/Firmware,jlecoeur/Firmware,mje-nz/PX4-Firmware,acfloria/Firmware,PX4/Firmware,PX4/Firmware,dagar/Firmware,mje-nz/PX4-Firmware,jlecoeur/Firmware,acfloria/Firmware,PX4/Firmware,dagar/Firmware,darknight-007/Firmware,dagar/Firmware,Aerotenna/Firmware,krbeverx/Firmware,mje-nz/PX4-Firmware,jlecoeur/Firmware,krbeverx/Firmware,acfloria/Firmware,PX4/Firmware,mje-nz/PX4-Firmware,jlecoeur/Firmware,krbeverx/Firmware,dagar/Firmware