two-step sweep option for trajopt, and ignore some self collisions using ros config file
print out table of total results