fit-model: Replaced affine camera estimation with nonlinear algorithm (allows direct recovery of the pose angles)