Fix black screen bug for pcl_kinfu_app with -r and -pcd