使用GPS传感器飞行器自动抛物系统设计.docVIP

使用GPS传感器飞行器自动抛物系统设计引言 现代飞行器在社会各领域都有广泛的应用，其中利用飞行器进行物资的运输投放也颇为常见。例如，在发生重大自然灾害时，由于路面交通的损坏，将使得空中运输成为受灾区域各物资来源的唯一途径[1]。以往飞行员在投放物资时，往往根据经验通过目测来确定投放时机，但是这样往往会给地面人员的物资拾取带来很大的不便，尤其是在地理环境复杂的山区[2]。GPS传感器是一种能够全天候、实时地提供载体位置信息的传感器，在很多领域均有广泛应用[3]。若能利用GPS传感器采集详细的飞行器位置信息，并通过飞行器中央处理单元依据这些信息快速计算出抛物的准确时机，则可以有效地提高物资投放的准确性。此外，飞行器抛物系统在军事上也有广泛用途，如利用无人飞行器进行投弹等。 本设计将GPS数字传感器整合到小型无人飞行器上，经ADuC7026单片机精确运算处理后，对目标位置进行准确抛物。 总体方案设计及飞行抛物算法 总体设计 本文设计的飞行器抛物系统的抛物过程如图1所示，为了能精确地将物体投掷到目标点，必须在飞行器距离目标点一定距离时便提前开启抛物装置，使物体在空中以一定的初速度做自由落体运动直至到达目标点。 飞行器抛物系统主要分为测量传感单元、主控单元和执行单元，如图2所示。测量传感单元采用Trimble公司生产的C2626型GPS数字传感模块和ADI公司生产的ADXRS612型MEMS陀螺仪，主要用于获取飞行器的空间坐标及俯仰角信息。主控模块采用ADI公司生产的ADuC7026单片机，用于实现对位置坐标的采集及解算，并结合抛物算法输出控制指令驱动执行模块抛物。 本设计中，将欲投掷目标点的坐标信息预先写入单片机，然后由ADuC7026单片机接收GPS的导航电文，解码出当前位置的经纬度、高度、水平速度，并结合陀螺仪检测出当前的俯仰角。最后根据飞行高度、水平速度、俯仰角以及飞机与目标点的相对位置信息，计算出最佳抛物时机所处的位置，当飞机到达此位置时，由ADuC7026单片机产生的PWM信号控制舵机使之打开挡板开关，最终实现自动抛物。 飞行抛物算法为了更全面地分 析飞行器抛物过程，可以将一个随机的抛物过程可以分为两种类型，即斜上抛物和斜下抛物(水平抛物可以看作上述两种类型的特殊情况)，这两种类型分别对应俯仰角α0和α0，二者对应的运动轨迹如图3所示。其中横轴代表水平距离，纵轴代表竖直高度。 从起抛点到目标点的水平距离即为提前抛掷阈值，根据抛物运动的相关知识不难得出以下公式： 斜上抛物时提前抛物距离阈值D1 俯仰角的修正 虽然MEMS陀螺仪具有体积小、成本低、易于集成等优点，但是它的速率输出易受温度等环境因素影响而产生漂移，这会给俯仰角的测量带来随时间不断积累的误差[4]。而通过GPS传感器的修正可以较好地弥补这一不足，修正方法如下： 利用GPS传感器求取俯仰角的方法如图4所示。只要计算出飞行器当前时刻与前一时刻的高度差H?和水 若设定G P S信息更新频率为5Hz(即每200ms导航电文更新一次)，那么单片机每隔200ms就将通过GPS传感器的信息对俯仰角进行一次修正。相对于采用单一传感器测量的方式而言，这种采用MEMS陀螺仪与GPS传感器结合测量俯仰角的方式即保证了实时性又提高了测量精度。 本系统采用电压为12V的大容量锂聚合物电池供电，经稳压芯片处理后供给各单元电路，主要硬件单元连接框图如图5所示。 主控单元 本设计中主控芯片采用的是ADI公司的ADuC7026单片机。ADuC7026集成了ARM7TDMI内核，其外设包括一个比较器，可编程逻辑阵列(PLA)和3相脉宽调制(PWM)发生器，40个通用I/O口，1个UART等。当工作在41.78MHz时，其功耗一般是120mW[5]。可见，ADuC7026单片机具有较低的功耗和优越的性能，满足本系统设计要求。 传感器单元 GPS传感器采用Trimble公司生产的C2626型GPS模块，它具有体积小、定位快速准确等优点，并提供多种格式的导航电文输出，它可以通过UART串口把坐标信息传送给ADuC7026单片机进行处理。陀螺仪采用ADI公司生产的ADXRS612型陀螺仪，它的测量范围可达±300°/s，采用模拟电压输出，可以通过单片机的ADC进行数据采样。 执行单元 执行单元采用Futaba S3003型舵机来驱动机械投掷装置。舵机的驱动信号是一个周期为20ms，脉宽在1ms至2ms之间变化的PWM信号，脉宽为1ms时对应舵机的左极限位置，对应机械装置闭合。脉宽为2ms时对应舵机的右极限位置，对应机械装置开启。利用ADuC7026单片机的PWM发生器编程产生的驱