Added cage environment setup for moveit