一种基于安卓手机和外部传感器的无人机飞行控制系统的制作方法
【技术领域】
[0001]本发明属于无人机飞行控制领域，涉及一种基于安卓手机和外部传感器的无人机飞行控制系统。
【背景技术】
[0002]无人机飞行控制系统需搭载加速度计、陀螺仪、气压计、GPS、磁力计等多种传感器，从而感知飞行器的运动状态，实现飞行器的稳定控制。目前基于智能手机的飞行控制系统方案，利用手机搭载的传感器和运算单元，实现无人飞行器的导航、控制功能。然而，智能手机搭载的传感器受成本、用途等限制，常常缺少无人机飞行控制系统所需的某一种或多种传感器；即便搭载了某种传感器，其传感精度或采样频率往往较低，因此完全基于智能手机自身传感器的飞行控制系统的控制效果较差。此外，安卓操作系统启动或关闭拍照任务会消耗大量的系统资源，会引起传感器采样频率急剧下降，引发飞行器姿态剧烈抖动，在极端情况下甚至引发坠机。
【发明内容】
[0003]本发明的目的在于针对现有技术存在的缺陷和不足，提供一种基于安卓手机和外部传感器的无人机飞行控制系统，具有节约系统资源，稳定性高，易于控制的优点。
[0004]为实现上述目的，本发明采用以下技术方案:包括依次连接的:固定于无人机中且为安卓操作系统的智能手机、传感伺服控制器和飞行器执行机构；
[0005]所述的安卓操作系统的智能手机内安装有飞行控制程序；
[0006]所述的智能手机内设置有:陀螺仪、加速度计、GPS和磁场传感器；
[0007]所述的传感伺服控制器内设置有:陀螺仪、加速度计、气压计、磁场传感器等外部辅助传感器、GPS、定时器和AD采样器；
[0008]所述的传感伺服控制器中设置有连接至无人机飞行器执行机构的PffM生成定时器。
[0009]所述的安卓操作系统的智能手机与飞行器之间设置有减震装置。
[0010]所述的传感伺服控制器中的定时器包括:PWM捕获定时器和PffM生成定时器。
[0011]所述的智能手机与传感伺服控制器之间的数据连接方式为USB连接或蓝牙连接。
[0012]所述的安卓操作系统的智能手机中设置有能够调用的前后摄像头，并通过3G/4G/wifi网络实时远程传输照片或视频。
[0013]所述的飞行控制程序的运行频率为90Hz?520Hz。
[0014]传感伺服控制器由智能手机usb 口供电。
[0015]所述智能手机安装时屏幕与水平面垂直。
[0016]与现有技术相比，本发明具有以下有益的技术效果:本发明由于包括:固定于无人机中且依次连接的为安卓操作系统的智能手机、传感伺服控制器和飞行器执行机构；安卓操作系统的智能手机内安装有飞行控制程序；智能手机内设置有:陀螺仪、加速度计、GPS和磁场传感器；传感伺服控制器内设置有:陀螺仪、加速度计、气压计、磁场传感器等外部辅助传感器、GPS、定时器和AD采样器；传感伺服控制器中设置有连接至无人机飞行器执行机构的PWM生成定时器。从而通过智能手机中的陀螺仪、加速度计、GPS和磁场传感器实时获得无人机的姿态及飞行数据，且由于无人机的飞行程序，通过将智能手机内部传感器与传感伺服控制器提供的外部辅助传感器相结合，计算获得飞行器准确的姿态、位置信息，由智能手机内部的飞行控制程序进行运算获取初步控制指令，发送到传感伺服控制器进一步处理，进而驱动飞行器的执行机构，实现飞行器的稳定控制。本系统操作简单，稳定性好，适用于大面积推广和使用。
[0017]进一步的，由于智能手机与传感伺服控制器之间的数据连接方式为USB连接或蓝牙连接，从而保证了数据传输的稳定性和精确性。
[0018]进一步的，由于安卓操作系统的智能手机中设置有能够调用的前后摄像头，并通过3G/4G/wifi网络实时传输，使实时图像不只局限于操纵者本人观看。
[0019]进一步的，由于飞行控制程序的运行频率为90Hz?520Hz，从而能够使得控制效果更好，更加稳定。
[0020]进一步的，智能手机安放时屏幕垂直于水平面，可向用户显示飞行参数或其他信息。使得操纵者更好的了解无人机的动态，更加有利于操纵。
【附图说明】
[0021]图1为本发明结构示意图。
[0022]图2为本发明流程图；
【具体实施方式】
[0023]本发明采用外部传感器对智能手机内部的传感器进行补充和优化，从而获取更好的传感信息，使得基于智能手机的飞行控制系统具备更好的控制效果。同时，采用有效的任务调度机制，使飞行器拍摄照片、视频时仍然保持稳定的飞行。
[0024]飞行控制系统，通过将手机内部传感器与传感伺服控制器提供的外部辅助传感器相结合，计算获得飞行器准确的姿态、位置信息，由智能手机内部的飞行控制程序进行运算获取初步控制指令，经由usb 口或蓝牙接口发送到传感伺服控制器，进而驱动飞行器的执行机构进一步处理后，实现飞行器的稳定控制。本发明中，经实验测定，当控制程序运行频率在90Hz至520Hz之间时，有最好的控制效果。
[0025]所述的智能手机，搭载加速度计、陀螺仪等无人机飞行控制所必须的部分传感器，配备触摸屏幕作为飞行控制系统与用户交互的界面之一。智能手机在本发明的飞行控制系统中起主要的传感、计算、人机交互等作用。
[0026]所述的传感伺服控制器，搭载部分无人机飞行控制系统所需的传感器，作为对智能手机上未装备的传感器的补充，或对智能手机上搭载了但精度不足的传感器提供更高精度的优化。此外，传感伺服控制器通过USB或蓝牙方式与智能手机实现数据连接，一方面将其搭载的传感器的实时数据发送给智能手机，用于飞行控制指令的计算；另一方面，接收智能手机发送来的飞行控制计算结果，经进一步处理后，生成最终控制指令，发送给飞行器的执行机构。
[0027]智能手机内有飞行控制所需的部分传感器(例如陀螺仪、加速度计等)，通过获取传感伺服控制器发送来的补充传感器数据，经过与手机自带的运动状态估计程序，将传感器数据组合、融合后，经过滤波、微分、积分等运算处理，最终获得飞行器的运动状态的估计值。通过将解算得到的运动状态与期望运动状态对比，采用PID或其他控制算法，获取初步的控制指令。这里，期望运动状态为飞行器接收到的操纵者的指令状态，或飞行器在自动执行任务时为满足任务需求而由程序计算得出的目标状态。通过获取运动状态向量与期望运动状态向量相减获取两者的偏差，对此偏差进行微分、积分和增益运算后，将此三者经线性或非线性组合，生成初步的控制指令。
[0028]初步控制指令由usb接口或蓝牙接口发送给传感伺服控制器。传感伺服控制器对从智能手机接收到的初步控制指令进行进一步处理，然后将处理结果通过PWM生成定时器生成飞行器执行机构可辨识的控制信号，进而发出控制指令。
[0029]飞行器执行机构在接收到控制指令后，偏转舵面或改变螺旋桨转速或改变桨距，从而改变飞行器的运动状态，达到期望的飞行状态。
[0030]安卓操作系统的智能手机中设置有能够调用的前后摄像头，并通过3G/4G/wifi网络实时远程传输照片或视频。飞行控制程序的运行频率为90Hz?520Hz。传感伺服控制器由智能手机usb 口供电。手机安放时屏幕垂直于地面，能够向在飞行过程中向用户显示飞行参数或其他信息。
[