Adding the IRLS rotation averaging algorithm. Still debugging