Bug Fixes

config/search.yaml

@@ -4,7 +4,6 @@ marker:
   size: 0.5
   landing_ids: [0]
   target_ids: [1]
-  target_position: [5.0, 3.0]
 spiral:
   max_legs: 35
 lawnmower:

docs/architecture.md

@@ -141,22 +141,24 @@ src/
 ├── main.py                      # Entry point
 ├── vision/
 │   ├── object_detector.py       # ArUco marker detection
-│   ├── visual_odometry.py       # Feature tracking VO
-│   ├── optical_flow.py          # LK optical flow
 │   └── camera_processor.py      # Gazebo camera feeds
-├── localization/
-│   ├── position_estimator.py    # Weighted fusion
-│   └── ekf_fusion.py            # EKF fusion
 ├── navigation/
-│   ├── local_planner.py         # Path planning
+│   ├── search.py                # Search algorithm controller
-│   └── waypoint_follower.py     # Waypoint tracking
+│   ├── flight_tracker.py        # Live flight visualization
+│   └── patterns/
+│       ├── spiral.py            # Expanding square spiral
+│       ├── lawnmower.py         # Back-and-forth lanes
+│       └── levy.py              # Lévy walk random search
 ├── control/
-│   ├── uav_controller.py        # UAV flight control
+│   ├── uav_controller.py        # UAV flight control (pymavlink)
-│   ├── ugv_controller.py        # UGV drive control
+│   └── ugv_controller.py        # UGV drive control (gz.transport)
-│   └── search.py                # Search algorithms
+├── safety/
-└── safety/
+│   └── geofence.py              # GPS boundary enforcement
-    ├── geofence_monitor.py      # GPS boundaries
+└── utils/
-    └── failsafe_handler.py      # Emergency handling
+    ├── config.py                # YAML config loader
+    ├── convert.py               # Unit/coordinate conversions
+    ├── helpers.py               # Distance utilities
+    └── recorder.py              # Video recording & cloud upload
 ```
 
 ## Configuration

docs/troubleshooting.md

@@ -136,10 +136,6 @@ source activate_venv.sh
 pip install pexpect future
 ```
 
-source activate_venv.sh
-pip install pexpect future
-```
-
 ### Build Failed (Missing catkin_pkg)
 
 **Symptoms:**

scripts/run_autonomous.sh

@@ -98,7 +98,7 @@ print_info "==================================="
 print_info "  UAV-UGV Simulation"
 print_info "==================================="
 print_info "World:    $WORLD_FILE"
-print_info "Mission:  $MISSION"
+print_info "Search:   $SEARCH"
 echo ""
 GZ_DEFAULT_GUI="/usr/share/gz/gz-sim8/gui/gui.config"
 GZ_USER_GUI="$HOME/.gz/sim/8/gui.config"
@@ -147,12 +147,19 @@ if [ -f "$PARAM_FILE" ]; then
 fi
 sim_vehicle.py $SITL_ARGS &
 SITL_PID=$!
-print_info "Waiting for SITL (~20s) ..."
+print_info "Waiting for SITL to start ..."
-sleep 20
+SITL_TIMEOUT=60
-if ! pgrep -f "arducopter" > /dev/null 2>&1; then
+SITL_WAITED=0
-    print_error "ArduPilot SITL failed to start"
+while ! pgrep -f "arducopter" > /dev/null 2>&1; do
-    exit 1
+    sleep 2
-fi
+    SITL_WAITED=$((SITL_WAITED + 2))
+    if [ $SITL_WAITED -ge $SITL_TIMEOUT ]; then
+        print_error "ArduPilot SITL failed to start after ${SITL_TIMEOUT}s"
+        exit 1
+    fi
+    print_info "  Waiting for arducopter process ... (${SITL_WAITED}s)"
+done
+sleep 5
 print_success "ArduPilot SITL running (TCP 5760)"
 print_info "[3/4] Starting main.py ..."
 cd "$PROJECT_DIR"

src/navigation/search.py

@@ -414,8 +414,6 @@ class Search:
         print()
         return False
 
-        return False
-
     def move_to_local(self, x, y):
         z = -self.altitude
         self.ctrl.move_local_ned(x, y, z)

src/utils/recorder.py

@@ -337,7 +337,40 @@ class RunRecorder:
             threading.Thread(target=self._upload_file, args=(path, filename), daemon=True).start()
 
     def save_summary(self, search_mode="", altitude=0, markers=None, landed=False, ugv_dispatched=False, ugv_target=None, extra=None):
-        pass
+        duration = time.time() - self.start_time
+        summary = {
+            "search_mode": search_mode,
+            "altitude": round(altitude, 2),
+            "duration_seconds": round(duration, 1),
+            "search_duration_seconds": round(self.search_duration, 1),
+            "landed": landed,
+            "ugv_dispatched": ugv_dispatched,
+            "markers_found": 0,
+            "markers": {},
+            "timestamp": datetime.now().isoformat(),
+        }
+        if ugv_target:
+            summary["ugv_target"] = ugv_target
+        if markers:
+            summary["markers_found"] = len(markers)
+            for mid, info in markers.items():
+                pos = info.get("uav_position", {})
+                summary["markers"][int(mid)] = {
+                    "x": round(pos.get("x", 0), 2),
+                    "y": round(pos.get("y", 0), 2),
+                    "distance": round(info.get("distance", 0), 2),
+                }
+        if extra:
+            summary.update(extra)
+
+        path = self.run_dir / "summary.yaml"
+        try:
+            with open(path, "w") as f:
+                yaml.dump(summary, f, default_flow_style=False, sort_keys=False)
+            print(f"[REC] Summary saved: {path}")
+            threading.Thread(target=self._upload_file, args=(path, "summary.yaml"), daemon=True).start()
+        except Exception as e:
+            print(f"[REC] Failed to save summary: {e}")
 
     def stop(self):
         self._recording = False