fix environment collision

This will fix environment collision detection (with ed). Apparently
the &dist parameter doesn't work correctly in simulation and will be
disabled. This will lead to worse performance because we don't prune
environment collisions. I hope to fix this later when I have some
more time to dive into this.