Added basic functionality to save point clouds to file