Added CameraModel and TrajectoryEstimator tests, added darts intrinsics camera model to CameraModel and extrinsics to Transforms, and added trajectory estimator to Darts main loop