Revert "Disable MPS tests, failing due to moveit#432"

This reverts commit 5382338.

Author: rhaschke

core/python/test/rostest_mps.py

@@ -81,7 +81,7 @@ def test_fw_remove_object(self):
         s = self.task.solutions[0].toMsg()
         self.assertEqual(s.sub_trajectory[1].scene_diff.world.collision_objects[0].id, "box")
 
-    def DISABLED_test_bw_add_object(self):
+    def test_bw_add_object(self):
         # add object to move_group's planning scene
         self.psi.add_box("block", make_pose(0.8, 0.55, 1.25), [0.2, 0.2, 0.2])
 
@@ -104,7 +104,7 @@ def DISABLED_test_bw_add_object(self):
         objects = [o.id for o in s.sub_trajectory[1].scene_diff.world.collision_objects]
         self.assertTrue(objects == ["block", "box"])
 
-    def DISABLED_test_bw_remove_object(self):
+    def test_bw_remove_object(self):
         mps = stages.ModifyPlanningScene("removeObject(box) backwards")
         mps.removeObject("box")
         self.task.insert(mps, 0)