Initial commit

This files read pcd file (test_pcd.pcd) and filters it and prints the output