Updated example to properly use cached planning scene