Finished extrinisic estimation program