Q-PSO: fast quaternion-based pose estimation from RGB-D images