def test_extract_goal_info(self):
     pm = VisionModule()
     pm.start(self.data)
     p = test_utils.get_init_pose()
     self.data_mock["Pose"] = p
     pm.transformer.update_pose(self.data_mock["Pose"])
     self.data_mock["CameraFrameVersion"] = 1
     goal_info = (((0,0,0),(0.0,0.0,0)), None)
     pm.extract_goal_infos(self.data_mock, goal_info)
     self.assertTrue(self.data_mock[DATA_KEY_GOAL_FOUND])
     self.assertTrue(len(self.data_mock[DATA_KEY_GOAL_INFO]) == 2)