pc_align: Sort the errors
point2dem: Robustness: Create output dir
pc_align: More functionality and code cleanup