Correct initialization of transpose matrices + minor changes

src/Mathematics/intermediate-qp-matrices.cpp

src/ZMPRefTrajectoryGeneration/generator-vel-ref.cpp

src/ZMPRefTrajectoryGeneration/generator-vel-ref.hh