Change to ViconPublisher: not publishing if occluded

pps_ws/src/d_fall_pps/param/Crazyflie.db

-3,cfTwo,0/69/2M,0,0,0,1,1,1
-5,cfFour,0/99/2M,-1,0,0,0,1,1
+3,cfTwo,0/69/2M,-2,-2,0,2,2,2
+5,cfThree,0/72/2M,-2,-2,0,2,2,2

pps_ws/src/d_fall_pps/src/ViconDataPublisher.cpp

@@ -216,8 +216,7 @@ int main(int argc, char* argv[]) {
             cfData.pitch = pitch;
             cfData.yaw = yaw;
             cfData.acquiringTime = totalViconLatency;
-
-            viconData.crazyflies.push_back(cfData);
+            if(!outputTranslation.Occluded) viconData.crazyflies.push_back(cfData);
         }
         viconDataPublisher.publish(viconData);
     }