Switched to {i,j,k,1} quaternion convention to be consistent with the MSCKF paper (and Tim)