zamienMacierzNaKwaternion(kwaternion,Macierz);
zamienKwaternionNaMacierz(macierzOstateczna,kwaternion);

mając macierz ostateczną jak wyznaczyć macierz PRZED zmiana na kwaternion