|
背景描述 近年来无人机应用市场日趋火热，无人机开始被应用在多个领域之中，比如航拍，植保，运输，安防等。随着应用场景的增加，对于无人机的大脑一飞控，的性能和功能要求也变得越来越高。国内具有一大批优质的无人机企业，如DJI，零度，亿航，极飞等。可是这些企业的飞控系统并不开源，而开源飞控市场却基本被国外所垄断，比如APM, PX4, Autoquad等，国内目前还没有一款开源飞控可以与之抗衡，在国际上也没有令人熟知的“国产”开源飞控。正是基于开发出一款世界知名的中国的开源飞控，我从2016年开始了StarryPilot这个项目。飞控的设计理念是一款轻量，功能强大的飞控，主要面向科研和无人机行业应用，使得无人机开发技术更加普及，也更容易将无人机技术应用到各个行业。
无人机整机
Pixhawk
室外定高飞行
Gazebo HITL(硬件在环)仿真
Msh shell系统 开发环境
硬件采用国外开源的自驾仪Pixhawk(http://pixhawk.org/modules/pixhawk), 如下图所示。Pixhawk也是目前世界上应用最广，支持的飞控系统最多的开源飞控硬件。
整个系统除了Pixhawk之外，还有一些外接的电子设备，如无刷电机，GPS，电调，数传，RC接收机，Lidar-Lite激光雷达等。整体的系统框架图如下图所示：
软件采用分层结构设计，如下图所示，从底层到上层分别是Driver层，RTOS(RTT + Fatfs)，HAL硬件虚拟层，Framework层和应用层。
Driver层实现了Pixhawk板载的所有硬件设备的驱动，如传感器设备(陀螺仪，加速度计，磁力计，气压计等)，总线设备(UART, I2C, SPI等)，USB，电机驱动，SD卡驱动，GPS驱动，LED灯以及一些板载设备的驱动。各个驱动以Device的形式向RTT进行注册，并且提供各自的init(), read(), write, ioctrl()函数供上层调用。这里仅以hmc5883磁力计的驱动举例说明驱动程序的一般设计步骤。 - 设备初始化函数5 |( d$ k% E$ @) y$ ?/ q& n 如下为hmc5883的初始化函数。首先对设备的功能函数进行函数指针赋值，这里定义了init(), read()和ioctrl()三个函数。然后向RTT注册名为hmc5883的驱动设备，上层可以通过查找设备名的方式来获取该驱动设备。接下来就是给hmc5883设置对应的总线设备。这里 hmc5883使用的是i2c通信，所以初始化中会为其查找对应的i2c设备。
- init()函数 Init()函数主要做一些芯片的初始化的工作，包括寄存器配置等。
- read()函数 read()函数实现设备数据读取的功能,如原始磁场数据和标定后的磁场数据读取。
- ioctrl()函数 Ioctrl()函数主要实现一些设备的配置功能，如设置测量磁场的范围，采样频率等。
RTOS采用RT-Thread嵌入式操作系统，它的功能强大，除了提供基本的线程调度，内存管理，同步等基本功能外，还提供了如msh的shell系统，device设备驱动系统，使得系统的整体架构更加清晰，功能也更加完善。 三、HAL层HAL层主要是对底层驱动设备进行进一步封装，将具体的设备抽象为一个类别的设备。以串口设备为例，不同的硬件平台，串口的底层驱动会有差异，通过HAL层，将串口设备封装为统一的接口，这样当系统移植到不同平台的时候，上层代码不需要做任何改变，而只需要将对应底层驱动进行简单替换就行。这将大大降低系统移植的复杂程度。 四、Framework层Framework层实现了飞控设备的主要功能，如姿态估计，位置估计，控制器，通信，日志管理等等。可以说，这一层是整个系统的核心，大部分的功能模块都在这一层来实现。 五、Application层应用层是将飞控的各个大的功能进行分割，变成一个个小的功能。每个功能在系统中为一个单独的线程，每个线程负责执行自己的任务，并且跟其他线程通过IPC进行通信。Vehicle线程具有最高优先级，执行周期为1ms。其负责实现无人机飞行相关的所有功能，如状态估计和电机的控制。 启动流程下面介绍一下系统的启动流程. 启动流程沿用RTT提供的原始结构。首先在rtthread_startup()函数中进行RTOS的一些初始化，然后进入到rt_application_init()中。 在这个函数中会建立一个init的初始线程，在这个线程中，会对飞控各个模块进行初始化的工作。在初始化完成之后，会根据Application层的定义，建立各个线程，并唤醒，最后将init线程自己给销毁掉，避免不必要的内存消耗。 演示视频控制算法和飞行效果测试( ADRC vs PID ) # k4 f* a' Q& G( b0 V
软件代码: http://github.com/JcZou/StarryPilot : I- c: \/ C5 w* ~; x) m8 x9 E9 B1 z |
微信公众号
手机版
关注RTT公众号看吧，公众号ID：RTThread