add usable function (creation matrix from quat and pos)