Added a SupervisedDescentPoseEstimation class that encapsulates all the pose estimation stuff

- Added an app to test the sdm pose estimation