Added feature requested by Jordan to disable the collision check of the non-planning links against the world. You can call the new function to enable/disable the collision check.