Update - Final Point Cloud Implementation

Will branch for furthe research