Dronekit Python无人机无法飞往指定位置问题排查求助

Hey there! Let's break down why your drone's having trouble reliably reaching the target GPS location sent from your Android app. Since you suspect LocationGlobalRelative might be the issue, we'll start there and cover other common pitfalls that could be causing the inconsistent behavior.

1. Double-Check LocationGlobalRelative Parameter Accuracy #

The most common mistake with this class is mixing up relative vs absolute altitude:

• LocationGlobalRelative expects altitude to be relative to the drone's takeoff point (in meters). If your Android app is sending absolute GPS altitude (MSL), you need to convert it to relative height first.
• Fix example:

  # Get drone's takeoff absolute altitude once after arming
  takeoff_alt_abs = vehicle.location.global_frame.alt
  
  # When receiving Android GPS data:
  android_lat = ... # Your parsed latitude
  android_lon = ... # Your parsed longitude
  android_alt_abs = ... # Android's absolute altitude
  target_alt_rel = android_alt_abs - takeoff_alt_abs
  
  # Now create the correct target location
  target_location = LocationGlobalRelative(android_lat, android_lon, target_alt_rel)
  

• Also verify that your parsed latitude/longitude values are valid (no NaN, 0, or out-of-range numbers) — bad coordinates will obviously send the drone nowhere useful.

2. Ensure the Drone is in the Right Mode & State Before Sending goto #

simple_goto only works reliably when the drone is in GUIDED mode and has stabilized after takeoff:

• Add checks to confirm mode and altitude before sending the target:

  # Wait for GUIDED mode
  while vehicle.mode.name != "GUIDED":
      vehicle.mode = VehicleMode("GUIDED")
      print("Switching to GUIDED mode...")
      time.sleep(1)
  
  # Wait for drone to reach a stable takeoff altitude (e.g., 2m)
  while vehicle.location.global_relative_frame.alt < 2.0:
      print(f"Climbing to takeoff altitude: {vehicle.location.global_relative_frame.alt:.1f}m")
      time.sleep(0.5)
  
  # Now send the goto command
  vehicle.simple_goto(target_location, groundspeed=3) # Set a reasonable groundspeed
  

3. Validate GPS Data Reception from Android #

Flaky communication between your Android app and Python script can cause missed or corrupted target coordinates:

• Add logging for every received GPS payload to confirm data consistency:

  # After parsing Android data
  print(f"Received target: Lat={android_lat:.6f}, Lon={android_lon:.6f}, Alt(abs)={android_alt_abs:.1f}m")
  

• If you're using HTTP/REST for communication, consider adding retries or validation (e.g., check that coordinates are within a reasonable range for your test area) before passing them to the drone.

4. Add Post-goto Tracking to Confirm Progress #

Don't just send the command and assume it works — track the drone's position to see if it's actually moving toward the target:

• Use DroneKit's built-in get_distance_metres function to monitor progress:

  from dronekit import get_distance_metres
  
  while True:
      current_loc = vehicle.location.global_relative_frame
      distance_to_target = get_distance_metres(current_loc, target_location)
      print(f"Distance to target: {distance_to_target:.1f}m")
  
      if distance_to_target < 1.0: # Consider target reached within 1m
          print("Target reached!")
          break
      time.sleep(1)
  

• This will help you confirm if the drone is ignoring the command entirely, or if it's just taking longer than expected to reach the target.

5. Check for DroneKit/Connection Issues #

Occasionally, the connection between your Python script and drone can drop or lag:

• Ensure your serial/network connection (USB, telemetry radio, etc.) is stable — loose cables or weak signals can cause command delays or failures.
• Update DroneKit-Python to the latest version to rule out bugs in older releases.

Start with verifying the altitude conversion for LocationGlobalRelative — that's the most likely culprit here. Add logging everywhere to track data flow, and make sure the drone is fully ready before sending the goto command. You should see a big improvement in reliability once these checks are in place!

内容的提问来源于stack exchange，提问作者Naphat Jenjiraphat