Major pose estimation changes; Submitted MLCD version