测试了模拟AGC和陀螺读数正常

增加AGC从陀螺跟踪代码，未完成