% Q is an Nx4 matrix of quaternions. weights is an Nx1 vector, a weight for each quaternion.
% Qavg is the weightedaverage quaternion
% Markley, F. Landis, Yang Cheng, John Lucas Crassidis, and Yaakov Oshman.
% “Averaging quaternions.” Journal of Guidance, Control, and Dynamics 30,
% no. 4 (2007): 1193-1197.
function [Qavg] = quatWAvgMarkley(Q, weights)
% Form the symmetric accumulator matrix
M = zeros(4, 4);
n = size