MWC 定高定点

ygl611 · 发表于 2012-5-10 10:25

MWC GPS定高国外早就有了，但需要I2C GPS支持，这个I2C GPS比较麻烦，单独为GPS配一个M328单片机转换I2C也不值得，经过一番捣鼓，终于可以让M328的MWC直接支持串口GPS了。

第一个视频试飞是小四轴，配置：XXD2208 KV1400 XXD 好赢25A 8038正反桨 2200锂电全重600克。

第二个视频试飞是稍大一点的四轴，配置： XXD 2212 KV1400 XXD 好赢25A 8038正反桨 2200锂电全重800克。

MWC 传感器配置均为：ITG3205  BMA020 HMC5883L  BMP085

小四轴用的是淘宝那种GPS（兼容玉兔那种，呵呵），大点的四轴用的自己做的GPS，直接作为二层板放上面，信号也很稳定。

简单叙述一下教程：
   MWC GPS代码很早就有了，但在1.9版本之前，GPS定位、回航只是简单的P D控制，P值根据四轴与定位点的距离，比例控制四轴向定位点倾斜角度；超过一定距离，由D值限制最大倾角。这种PD控制的结果，定位表现尚可。但回航速度不能很好控制，到达定位点后，四轴呈水平状态，但由于惯性，四轴继续向前飞，直到与定位点拉开距离，此时P值的作用使四轴相反方向倾斜，四轴又飞回来，这样循环往复，绕着定位点转。

最近，国外Eosbandi 将ACM的GPS定位代码改写到MWC中，采用飞行速度PI +偏转速率PID控制，使得四轴飞临定位点时，可以根据四轴飞行速度变化，提前控制四轴向飞行相反方向偏转，起到减速作用。从而达到较好定位和回航效果。

http://diydrones.com/profiles/blogs/ac2-loiter-tuner-sim 这里模拟演示了四轴PI+PID回航控制过程，可以输入不同的PI 和rate PID 参数试试模拟效果。输入合适的参数，四轴在飞近定点时，有明显减速过程。
Eosbandi 的PI+PID参数需要在源代码里修改，暂不支持在GUI里修改。默认值效果就很好。

   支持两种GPS模块，MTK3329和UBLOX模块，建议用UBLOX模块，相对漂移小，上面的视频里用的GPS就是UBLOX 模块。这两种模块都可以接受指令来改变串口通讯速率，所以即使模块默认输出为1Hz也没有关系，在GPS.pde 中通过设置不同的语句，使MTK3329和UBLOX模块分别输出10HZ和5HZ。程序中默认选择UBLOX GPS模块，设置后以57600速率输出5 HZ GPS数据。
   config.h 里设置 #define GPS_SERIAL 0 （328只能用串口0，2560可以改为2，使用串口2）  ，#define GPS_BAUD 57600（经设置后GPS模块的输出速率），#define GPS_DEFAULT_BAUD 9600 （设置前的GPS 模块 TX 输出速率，通常为9600）

   需要4根线连接GPS和MWC主板，负极，+5V，RX，TX，其中GPS的RX接MWC的TX，GPS的TX接MWC的RX。

   MWC主板通电，开始自检和程序初始化，如果这时GPS与MWC的通讯口连接正确，MWC板检测到GPS存在，就会建立与GPS的通讯，设置GPS的通讯速率和数据输出频率。如果MWC板子上有指示RX TX通讯的指示LED，可以看到MWC板子上的TX LED灯闪2下，输出指令改变GPS通讯速率和数据输出频率，随后 MWC主板 RX LED就会从1HZ闪烁变为10HZ 或5HZ快速闪烁。表示GPS与MWC连接成功！

   将四轴拿到外面的空旷处，等待GPS搜索卫星，一般1分钟左右就能搜到星，若搜星达到3颗以上，MWC板子上指示解锁的LED开始闪烁，闪数下，停1下，闪的次数就是搜星数。建议等搜星5颗以上，解锁MWC，当前位置就定义为回家的位置，可以飞了。

   需要连接电脑调试PID时候，取下GPS连接线，按照以前的步骤接上数据线就可以了。通电后，MWC检测不到GPS，就会建立与电脑GUI程序的通讯。

源程序下载地址：GPS.RAR， GUI 程序需要2.0的，20120504版本的GUI不能用于这个程序
http://www.multiwii.com/forum/viewtopic.php?f=7&t=1654
   MWC GPS定点和回家需要几个前提条件，1是自稳稳定，2是磁定向准确，3是气压定高好用。目前出差在外，等回家后抽空再详细说说以上要点。
   自稳稳定条件：
   1、平衡性能好的桨；2、电机倒装。这样降低了桨和电机支持点距离，有利于减少桨引起的震动；3、机架坚固无松动，刚性好，受外力形变小；4、达到以上条件，建议板子直接用尼龙柱固定到机架上，效果可能比用双面胶贴上还好，P值可以设置很大；5、LEVEL PID 中的I值尽量小一点，默认的0.045还是有晃动，设为0.01要好一些。对于2.0版固件，LEVEL 中的D值为100时，相当于以前版本的PI设置（没有D值），如果设为60、70等值，稳定性有提高，并减少抖动。

[ 本帖最后由 ygl611 于 2012-5-19 12:33 编辑 ]

cbpjx · 发表于 2013-11-14 19:39

好好好好好好好好好好好好好好好好好好

ywywxb · 发表于 2013-10-25 13:37

学习了。顶。

bromi · 发表于 2013-10-25 11:55

说的不错

liwenjie135 · 发表于 2013-10-25 08:24

接了GPS乱飞+炸鸡……回航高速草到地上爽炸……求救啊……GUI 里面的 POS POSR NAVR 怎么调试啊？？？恳请高手指点……另外非GPS模式，气压定高+磁定向模式，打方向转个弯，想把机头对着自己，可是往往在打方向的时候就掉高，或草到地上了，求救啊…… （磁偏角已经校准）

yy1315714 · 发表于 2013-9-21 21:09

这也叫定点啊，那这个点也太大了吧

28966199 · 发表于 2013-9-21 14:31

相当强大，收藏

9090950 · 发表于 2013-9-21 13:04

专业文字

9090950 · 发表于 2013-9-21 12:34

我的配置是以下这样的，无论如何调，总是跳一跳的。
是不是ATMega328P 单片机
◆ITG3205 三轴数字陀螺仪
◆BMA180 三轴数字加速度传感器（自动稳定用）
◆BMP085 数字气压传感器（锁定高度用）
是不是这个配置也就只能这样了

wolfforce · 发表于 2013-7-18 09:08

留下我深深的足迹，像楼主学习

mirikle · 发表于 2013-3-2 20:48

楼主的飞机好稳，请问用另外一块板做I2C GPS处理器需要怎么连线，是从板的A4, A5连到主板的A4,A5就行了吗？

donaldshp · 发表于 2012-10-4 19:44

幸运的雕刻时光 · 发表于 2012-9-17 11:54

好贴

aishadow · 发表于 2012-9-7 22:14

我的和你正相反，是俯仰前后摇晃，

donaldshp · 发表于 2012-9-4 00:07

玩MWC的顶一个，现在还在折腾，很多问题也不明白。

100001662 · 发表于 2012-7-26 14:25

:em15:

archfly · 发表于 2012-7-26 00:11

高人

zhangjie0203 · 发表于 2012-7-25 00:02

感谢楼主无私分享！请教一下楼主，一个比较弱的问题:em23:，我加了GPS，GPS可以正常工作，但是我不知道怎么使用GPS悬停和回家功能，麻烦请楼主讲述一下设置步骤？非常感谢！

勿殇小天 · 发表于 2012-7-19 16:57

必须顶起！！！！！

hemuyi · 发表于 2012-7-19 15:17

留名学习

MWC 定高定点

主题

标题

标题

【站内推荐】 /1