Added clear objects to onlinePlannerController
Removed extraneous commented code
Implemented call to clear existing graspable bodies before adding
bodies. Addresses issue #55, but needs testing.