Create pcd_write.cpp