using quaternions now. first tests show that it works. jacobians are following soon