tsdf to pointcloud is still empty, likely the update in update_kinfu_loop is wrong somehow