bfs3d is unchanged
first pass at cleaned up environment, quite a bit to do in moveit side
check in latest experiment