Sparse-then-dense alignment-based 3d map reconstruction method for endoscopic capsule robots