a bit of refactoring

made matrices-quaternions transformations. Still, I want to get it
clearer and rewrite, may be. At least there are comments supposed to be.