Update pcd_write.cpp