Nonlinear rotation optimization method. This method does not need a unit test since the cost function is tested already and this method is just plugging it into ceres

Change-Id: I4fd67c200f75d9107d0472257169659e25a94234