function u=rotate_v_by_q(v,q) q_inv= [q(1) -q(2) -q(3) -q(4)]'; u = q_mult2(q,q_mult2(v,q_inv)); end