查看: 1456|回复: 0

【飞控开发高级教程1】疯壳·开源编队无人机-飞控代码

[复制链接]
  • TA的每日心情
    开心
    2022-4-17 15:37
  • 签到天数: 1 天

    连续签到: 1 天

    [LV.1]初来乍到

    发表于 2022-8-23 11:19:57 | 显示全部楼层 |阅读模式
    分享到:
    COCOFLY教程
    ——疯壳·无人机系列
    飞控整机代码走读、编译与烧写




    1.png
    图1


    一、代码架构
      飞控的整体代码工程由 8 个工作组组成,分别是 Ctrl、Driver、VL53L1X、STM32_LIB、USB、USB/Lib、StartUP 以及 Drv_Point,如下图所示。

    2.png
    图2
      各个组的具体的代码功能如下表所示。

    表1.png
    表1

    二、代码走读

      系统的主函数部分是整个代码的起始运行位置,在主函数内主要做两个事情:1、初始化外设及参数,2、轮询线程。

    3.png
    图3
      系统的每一个线程都已经分配好了运行周期,在不同的线程里执行不同的事情,线程的切换通过函数指针的形式切换,而系统的运行时间由 sysTick 提供即系统的“滴答”时钟。各个线程的入口如下。

    4.png
    图4
      分别有 1000ms 周期的任务、50ms 周期的任务、20ms 周期的任务、10ms 周期的任务、6ms 周期的任务、4ms 周期的任务、3ms 周期的任务以及 2ms 周期的任务。
      整个飞控可以平稳飞行,重点在于控制部分,即工作组“Ctrl”里面的代码。如下图所示为“Ctrl”组的代码框架。

    5.png
    图5
      其中与遥控器、上位机的数据通信处理包含在 Data_Transfers.c 内。里面无非就是对数据包进行拆解包、封装包等。如下图所示为对接收到的遥控器数据进行解包分析的代码。

    6.png
    图6

    7.png
    图7

    8.png
    图8

    9.0.png
    9.1.png
    图9

    10.png
    图10

    11.png
    图11

    12.png
    图12

    13.png
    图13

    14.0.png
    14.1.png
    图14
      三轴数据的获取处理在 mpu_perpare.c 内,如下图所示。

    15.0.png
    15.1.png
    15.2.png
    图15
      PID 控制相关代码集中在 Ctrl.c 及 Alt_Ctrl.c 内,其中 Ctrl.c 负责角度环、角速度环 PID 控制,而 Alt_Ctrl.c 则负责高度环、高度速度环的 PID 控制。
      IMU.c 和 MotionCal.c 是保证整个飞控平稳飞行的重要一环,这两个 c 文件主要负责飞控的姿态解算、数据融合处理等。


      工作组“USB”以及“USB/Lib”,负责通过 STM32 自带的 USB,虚拟出串口,方便与上位机进行通信。
      此外为了保护开发者的劳动成果,Player_Flight.lib 还封装了秘钥验证激活算法、多机编队控制、水平方向的速度和位置环的 PID 控制以及 3D 翻滚控制代码。
      保存、编译最后把代码烧写的飞控主板中,配合遥控器就可以正常使用了。如下图所示 1 为保存、2 为编译、3 为下载烧写。

    16.png
    图16



    完整配套资料和对应开源套件地址:http://www.fengke.club

    如需定制开发,请通过官网“疯壳”网页底部的“联系我们”进行联系

    文件下载请点击: 【1】飞控整机代码走读、编译与烧写.pdf (1.17 MB, 下载次数: 3)
    回复

    举报

    您需要登录后才可以回帖 注册/登录

    本版积分规则

    关闭

    站长推荐上一条 3/5 下一条

    【参会150积分】2024 瑞萨电子MCU/MPU工业技术研讨会
    以“智慧控制,绿色可持续”为主题的瑞萨电子 MCU/MPU 工业技术研讨会将再次登录深圳/上海,聚焦于工业应用的最新技术和趋势,通过技术分享、案例展示和互动交流等形式,为工程师、行业人士提供共同交流、探讨、合作的平台,亲身体验瑞萨电子产品及方案,与瑞萨电子专家及合作伙伴面对面交流,共话工业新生态,共推工业的绿色可持续发展!

    查看 »



    手机版|小黑屋|与非网

    GMT+8, 2024-12-22 12:18 , Processed in 0.112575 second(s), 17 queries , MemCache On.

    ICP经营许可证 苏B2-20140176  苏ICP备14012660号-2   苏州灵动帧格网络科技有限公司 版权所有.

    苏公网安备 32059002001037号

    Powered by Discuz! X3.4

    Copyright © 2001-2024, Tencent Cloud.