用DW1000模块和MiniFly，我DIY了一个室内无人机编队系统（附代码避坑指南）

用DW1000和MiniFly打造室内无人机编队：从硬件改造到代码避坑全指南

当四台微型无人机在客厅里以厘米级精度同步画出几何图形时，邻居家孩子趴在窗台上惊呼的场景，让我觉得三个月来的深夜调试都值了。这不是商业级产品，而是用DW1000 UWB模块和MiniFly开源无人机搭建的DIY编队系统，总成本控制在2000元以内。本文将分享从电机改装、定位标签集成到飞行控制算法调参的全流程实战经验，特别会重点解析那些官方文档没写的"坑"——比如为什么你的无人机总在定位时突然"抽风"。

1. 硬件改造：让MiniFly扛起UWB模块的三大关键改装

原厂MiniFly设计初衷是娱乐飞行，搭载UWB模块后会出现动力不足、续航骤降的问题。经过七种改装方案测试，最终确定以下必改项：

1.1 动力系统升级清单

提示：电机安装需注意转向，倒置安装时务必核对转向标识。我们曾因接错线导致四台无人机在空中"打架"。

1.2 UWB标签集成方案

广州联网科技的DW1000模块尺寸为25×15mm，直接粘贴会影响重心平衡。推荐做法：

1. 3D打印专用支架（ STL文件下载 ）
2. 使用0.5mm厚碳纤维板手工切割
3. 模块供电从飞控5V引脚引出，需加装100μF电容滤波

// 电源检测代码示例（防止电压不稳导致定位漂移） void check_voltage() { float vbat = get_battery_voltage(); if(vbat < 3.7) { set_led_color(RED); emergency_land(); } }

2. UWB定位系统搭建中的五个"天坑"

2.1 基站布设的黄金法则

• 高度差陷阱：基站高度差超过1.2米时，Z轴误差会急剧增大
• 金属干扰：实验显示铝合金支架会使测距误差增加15cm
• 温度补偿：DW1000芯片在28℃以上时需启用内置校准

# 基站坐标自动校准脚本 def auto_calibrate(): for i in range(10): take_samples() if max(delta) < 0.05: break adjust_params()

2.2 数据抖动解决方案

实测发现原始定位数据会有±20cm跳动，采用移动加权平均滤波：

滤波前: [102, 115, 98, 121, 107] 滤波后: [105.3, 108.7, 107.2]

注意：滤波延迟控制在50ms内，否则会影响飞行稳定性

3. 飞行控制代码的魔鬼细节

3.1 伪WiFi通信协议实现

要让UWB模块模拟原厂WiFi通信，需处理三种数据帧：

1. 心跳包：每200ms发送0xAA 0x55
2. 控制指令：带CRC校验的14字节结构体
3. 紧急停止：连续3次0x55 0xAA

// 关键数据结构体 typedef struct { uint8_t head; uint8_t cmd; int16_t x_pos; int16_t y_pos; uint8_t checksum; } __attribute__((packed)) uwb_frame_t;

3.2 定点飞行状态机

采用有限状态机替代简单判断，解决"反复震荡"问题：

[IDLE] --收到坐标--> [APPROACHING] --进入半径--> [FINE_TUNING] ^ | | |________超时__________|_________偏移过大________|

4. 编队算法实战：从理论到摔机

4.1 三角形编队实现步骤

1. 主机计算各机目标点（余弦定理）
2. 动态调整队形缩放比例
3. 冲突检测半径设为机体直径1.8倍

# 队形生成算法 def triangle_formation(leader_pos, scale): angles = [30, 150, 270] # 单位：度 return [polar_to_cartesian(leader_pos, scale, a) for a in angles]

4.2 血泪换来的调试技巧

• LED可视化调试：用不同颜色表示飞行状态
• 地面站日志：SD卡记录每秒50组传感器数据
• 橡皮筋大法：测试阶段用橡皮筋拴住无人机

当看到四台无人机终于能在2m×2m空间内保持10cm间距同步盘旋时，凌晨三点的实验室响起了技术宅们才懂的欢呼声。这套系统现在已经成为我们创客空间的招牌项目，最近正在尝试加入视觉辅助定位——当然，这又是另一个充满"惊喜"的故事了。