Code for Robust Methods in SO(3)