Research Article
[Retracted] A 3D Reconstruction Method Using Multisensor Fusion in Large-Scale Indoor Scenes
Algorithm 2
Regional point cloud stack.
| | Procedure Regional point cloud stack | | | Submap ⟵ SubmapMessage | | | for i in size of (Submap), do | | | if position(Submap[i]) is changed and Submap[i] is not new Submap then | | | RegionalPointcloudUnfinish [IndexInRegional(i)] | | | ⟵Equation (25) (RegionalPointcloudUnfinish [IndexInRegional(i)], NewPosition(Submap[i])) | | | end if | | | else if Submap[i] is new Submap then | | | NewPointcloud ⟵ TimeSynchronized(Submap) | | | TransformedPointCloud ⟵ Equation (23) (NewPointcloud) | | | ShiftedPointcloud ⟵ Equation (25) (TransformedPointCloud, position(Submap[i])) | | | RegionalPointcloudUnfinish.pushback(ShiftedPointcloud) | | | ResidualPointcloud ⟵ ShiftedPointcloud + ResidualPointcloud | | | if sizeof(RegionalPointcloudUnfinish) ≥ threshold then | | | for j in range(threshold) | | | RegionAllPointcloud ⟵ RegionalPointcloudUnfinish[j] + RegionAllPointcloud | | | end for | | | RegionPointcloud.pushback(RegionAllPointcloud) | | | RegionalPointcloudUnfinish.clear() | | | ResidualPointcloud.clear() | | | return RegionAllPointcloud | | | else if | | | return RegionAllPointcloud + ResidualPointcloud | | | end if | | | end if | | | end if |
|