四轴起飞时,发出触发信号使导航模块开始工作,同时读取ICM20602的加速度计、陀螺仪数据,对数据卡尔曼滤波后姿态解算,对角度与角速度采取串级PID调节。控制系统算法设计主要有ICM20602滤波算法,姿态解算算法、串级PID控制算法和定高部分控制算法。碍于篇幅所限,下面介绍最重要的串级PID控制算法和定高部分控制算法。地理坐标系中重力的水平分量为零,仅用三轴陀螺仪和三轴加速度计无法计算出航向角,由于巡线机器人保持稳定飞行只需要横滚角(roll)和俯仰角(pitch),所以四元数转换成欧拉角。定高控制算法采用的是增量式PID控制,定高控制的输出最后与姿态控制的输出叠加到四个电机的控制中。数据滤波使用的是低通滤波,采用近三次的平均值。为了防止姿态对激光测距的影响及减小高度控制对姿态控制的干扰使用欧拉角来校正高度值,即Hight=(float)Hight*(cos(roll)* cos(pitch))。将四元数转换后的欧拉角与陀螺仪测出来的角速度进行串级PID控制,其中欧拉角作为外环,角速度作为内环。外环的PID以及内环的PD设定值为测试数据值。由于内环的角速度控制不需要无静差,所以内环采用PD控制,为防止测量的误差造成较大影响,外环积分需要限幅。
标签: 传感器
上传时间: 2022-06-24
上传用户:默默
逆变控制器的发展经历从分立元件的模拟电路到以专用微处理芯片(DSP/MCU)为核心的电路系统,并从数模混合电路过渡到纯数字控制的历程。但是,通用微处理芯片是为一般目的而设计,存在一定局限。为此,近几年来逆变器专用控制芯片(ASIC)实现技术的研究越来越受到关注,已成为逆变控制器发展的新方向之一。本文利用一个成熟的单相电压型PWM逆变器控制模型,围绕逆变器专用控制芯片ASIC的实现技术,依次对专用芯片的系统功能划分,硬件算法,全系统的硬件设计及优化,流水线操作和并行化,芯片运行稳定性等问题进行了初步研究。首先引述了单相电压型PWM逆变器连续时间和离散时间的数学模型,以及基于极点配置的单相电压型PWM逆变器电流内环电压外环双闭环控制系统的设计过程,同时给出了仿真结果,仿真表明此系统具有很好的动、静态性能,并且具有自动限流功能,提高了系统的可靠性。紧接着分析了FPGA器件的特征和结构。在给出本芯片应用目标的基础上,制定了FPGA目标器件的选择原则和芯片的技术规格,完成了器件选型及相关的开发环境和工具的选取。然后系统阐述了复杂FPGA设计的设计方法学,详细介绍了基于FPGA的ASIC设计流程,概要介绍了仅使用QuartusII的开发流程,以及Modelsim、SynplifyPro、QuartusII结合使用的开发流程。在此基础上,进行了芯片系统功能划分,针对:DDS标准正弦波发生器,电压电流双环控制算法单元,硬件PI算法单元,SPWM产生器,三角波发生器,死区控制器,数据流/控制流模块等逆变器控制硬件算法/控制单元,研究了它们的硬件算法,完成了模块化设计。分析了全数字锁相环的结构和模型,以此为基础,设计了一种应用于逆变器的,用比例积分方法替代传统锁相系统中的环路滤波,用相位累加器实现数控振荡器(DCO)功能的高精度二阶全数字锁相环(DPLL)。分析了“流水线操作”等设计优化问题,并针对逆变器控制系统中,控制系统算法呈多层结构,且层与层之间还有数据流联系,其执行顺序和数据流的走向较为复杂,不利于直接采用流水线技术进行设计的特点,提出一种全新的“分层多级流水线”设计技术,有效地解决了复杂控制系统的流水线优化设计问题。本文最后对芯片运行稳定性等问题进行了初步研究。指出了设计中的“竞争冒险”和饱受困扰之苦的“亚稳态”问题,分析了产生机理,并给出了常用的解决措施。
上传时间: 2013-05-28
上传用户:ice_qi
图像增强技术是数字图像处理领域中的一项重要内容,随着数字图像处理应用领域的不断扩大,快速、实时图像处理技术成为研究的热点。超大规模集成电路技术的飞速发展为数字图像实时处理技术提供了硬件基础,尤其是FPGA(Field Programmable Gate Array,现场可编程门阵列)凭借其高速并行、可重配置的架构和基于查找表的独特结构等优点使得在数字信号处理领域的应用持续上升。国内外,越来越多的实时图像处理应用逐渐转向FPGA平台。 本文基于FPGA的图像增强技术研究主要是针对空间域方法,这种方法是指在空间域内直接对像素灰度值进行运算处理,算法简单并且存在并行性,非常适合于用硬件实现。FPGA可以灵活地实现并行、实时处理图像数据,正是利用这一特点,本文提出了一种基于FPGA的图像增强处理系统设计。该系统采用SOPC技术,完成图像增强处理。文中给出了系统设计思路,并分析了该系统的结构及功能实现,说明了系统实现过程。其硬件平台的核心部分是Altera公司Stratix系列的.FPGA EPlS40芯片,采用自顶向下的设计方法构造图像增强处理功能模块,利用硬件描述语言vHDL对图像增强模块进行电路描述,并进行设计优化、仿真,在生成系统配置文件后加载到FPGA上进行板级调试。完成了基于FPGA的图像增强算法模块的设计,重点设计实现了点运算增强处理模块、中值滤波器模块,并对中值滤波器进行了改进设计实现,采用FPGA完成了对图像增强算法的硬件加速。
上传时间: 2013-06-16
上传用户:songrui
随着GPS(Global Positioning System)技术的不断发展和成熟,其全球性、全天候、低成本等特点使得GPS接收机的用户数量大幅度增加,应用领域越来越广。但由于定位过程中各种误差源的存在,单机定位精度受到影响。目前常从两个方面考虑减小误差提高精度:①用高精度相位天线、差分技术等通过提高硬件成本获取高精度;②针对误差源用滤波算法从软件方面实现精度提高。两种方法中,后者相对于前者在满足精度要求的前提下节约成本,而且便于系统融合,是应用于GPS定位的系统中更有前景的方法。但由于在系统中实现定位滤波算法需要时间,传统CPU往往不能满足实时性的要求,而FPGA以其快速并行计算越来越受到青睐。 本文在FPGA平台上,根据“先时序后电路”的设计思想,由同步没计方法以及自顶向下和自下而上的混合设计方法实现系统的总体设计。从GPS-OEM板输出的定位信息的接收到定位结果的坐标变换,最终到kalman滤波递推计算减小定位误差,实现实时、快速、高精度的GPS定位信息采集处理系统,为GPS定位数据的处理方法做了新的尝试,为基于FPGA的GPS嵌入式系统的开发奠定了基础。具体工作如下: 基于FPGA设计了GPS定位数据的正确接收和显示,以及经纬度到平面坐标的投影变换。根掘GPS输出信息标准和格式,通过串口接收模块实现串口数掘的接收和经纬度信息提取,并通过LCD实时显示。在提取信息的同时将数据格式由ASCⅡ码转变为十进制整数型,实现利用移位和加法运算达到代替乘法运算的效果,从而减少资源的利用率。在坐标转换过程中,利用查找表的方法查找转化时需要的各个参数值,并将该参数先转为双精度浮点小数,再进行坐标转换。根据高斯转化公式的规律将公式简化成只涉及加法和乘法运算,以此简化公式运算量,达到节省资源的目的。 卡尔曼滤波器的实现。首先分析了影响定位精度的各种误差因素,将各种误差因素视为一阶马尔科夫过程的总误差,建立了系统状态方程、观测方程和滤波方程,并基于分散滤波的思想进行卡尔曼滤波设计,并通过Matlab进行仿真。结果表明,本文设计的卡尔曼滤波器收敛性好,定位精度高、估计误差小。在仿真基础上,实现基于FPGA的卡尔曼滤波计算。在满足实时性的基础上,通过IP核、模块的分时复用和树状结构节省资源,实现数据卡尔曼滤波,达到提高数据精度的效果。 设计中以Xilinx公司的Virtex-5系列的XC5VLX110-FF676为硬件平台,采用Verilog HDL硬件描述语言实现,利用Xilinx公司的ISE10.1工具布局布线,一共使用44438个逻辑资源,时钟频率达到100MHZ以上,满足实时性信号处理要求,在保证精度的前提下达到资源最优。Modelsim仿真验证了该设计的正确性。
上传时间: 2013-04-24
上传用户:二驱蚊器
滤波器虽然是一种十分普通的器件,有关滤波的技术也 已经十分成熟。但是,现实情况是许多电磁兼容方面的问题 都是由于对干扰的滤波措施不当造成的。这是由于我们没有 掌握电磁干扰滤波的一些特点。为了在电磁兼容设计中应用 好滤波技术,正确掌握一些概念是十分必要的。共模干扰和 差模干扰的概念就是这样一种重要概念。正确区别共模和差 模干扰对于正确设计和使用滤波器十分重要。
上传时间: 2013-06-04
上传用户:skhlm
特点: 精确度0.1%满刻度 可作各式數學演算式功能如:A+B/A-B/AxB/A/B/A&B(Hi or Lo)/|A|/ 16 BIT类比输出功能 输入与输出绝缘耐压2仟伏特/1分钟(input/output/power) 宽范围交直流兩用電源設計 尺寸小,穩定性高
上传时间: 2014-12-23
上传用户:ydd3625
目录 第一章 传输线理论 一 传输线原理 二 微带传输线 三 微带传输线之不连续分析 第二章 被动组件之电感设计与分析 一 电感原理 二 电感结构与分析 三 电感设计与模拟 电感分析与量测
标签: 传输线
上传时间: 2013-12-12
上传用户:浩子GG
特点(FEATURES) 精确度0.1%满刻度 (Accuracy 0.1%F.S.) 可作各式数学演算式功能如:A+B/A-B/AxB/A/B/A&B(Hi or Lo)/|A| (Math functioA+B/A-B/AxB/A/B/A&B(Hi&Lo)/|A|/etc.....) 16 BIT 类比输出功能(16 bit DAC isolating analog output function) 输入/输出1/输出2绝缘耐压2仟伏特/1分钟(Dielectric strength 2KVac/1min. (input/output1/output2/power)) 宽范围交直流两用电源设计(Wide input range for auxiliary power) 尺寸小,稳定性高(Dimension small and High stability)
上传时间: 2013-11-24
上传用户:541657925
#include<iom16v.h> #include<macros.h> #define uint unsigned int #define uchar unsigned char uint a,b,c,d=0; void delay(c) { for for(a=0;a<c;a++) for(b=0;b<12;b++); }; uchar tab[]={ 0xc0,0xf9,0xa4,0xb0,0x99,0x92,0x82,0xf8,0x80,0x90,
上传时间: 2013-10-21
上传用户:13788529953
利用Atmel公司的ATmega168微处理器,采用A/D转换方式来实现按摩椅控制器的键盘接口,通过在硬件电路中巧妙地选择电阻,在软件设计中采用数字滤波、二分法和区间鉴定等方法,灵敏可靠地实现了按摩椅中30个按键的处理。给出了硬件电路设计和软件设计思想以及部分汇编代码。 Abstract: This paper chooses A/D conversion method to realize the keyboard interface of the controller by using ATmega168 microchip from Atmel Company.It accomplishes 30-key dealing sensitively and reliably in massage chair through skillfully selecting resistors in hardware circuit and using digital filter,dichotomy and area-judging method in software design.The hardware design circuit, software design idea and partly assembles code are presented mainly.
上传时间: 2014-01-10
上传用户:咔乐坞