四轴起飞时,发出触发信号使导航模块开始工作,同时读取ICM20602的加速度计、陀螺仪数据,对数据卡尔曼滤波后姿态解算,对角度与角速度采取串级PID调节。控制系统算法设计主要有ICM20602滤波算法,姿态解算算法、串级PID控制算法和定高部分控制算法。碍于篇幅所限,下面介绍最重要的串级PID控制算法和定高部分控制算法。地理坐标系中重力的水平分量为零,仅用三轴陀螺仪和三轴加速度计无法计算出航向角,由于巡线机器人保持稳定飞行只需要横滚角(roll)和俯仰角(pitch),所以四元数转换成欧拉角。定高控制算法采用的是增量式PID控制,定高控制的输出最后与姿态控制的输出叠加到四个电机的控制中。数据滤波使用的是低通滤波,采用近三次的平均值。为了防止姿态对激光测距的影响及减小高度控制对姿态控制的干扰使用欧拉角来校正高度值,即Hight=(float)Hight*(cos(roll)* cos(pitch))。将四元数转换后的欧拉角与陀螺仪测出来的角速度进行串级PID控制,其中欧拉角作为外环,角速度作为内环。外环的PID以及内环的PD设定值为测试数据值。由于内环的角速度控制不需要无静差,所以内环采用PD控制,为防止测量的误差造成较大影响,外环积分需要限幅。
标签: 传感器
上传时间: 2022-06-24
上传用户:默默
超声波测距系统硬件电路的研究与设计_汪群;高精度超声波测距方法与装置的研究_冷强;基于超声波测距的倒车雷达系统研究_汤传国;近距离高精度超声波测距系统的设计_邹轶,4篇论文参考供你掌握超声波测距知识
标签: 超声波测距
上传时间: 2022-07-18
上传用户:xsr1983
用单片机控制超声波的轮流发射,记录时间差,并算出距离
上传时间: 2013-06-18
上传用户:zhangzhenyu
采用自动增益控制(AGC)技术实现的宽频带放大器在雷达系统及其他相关电子领域有着广泛的应用。 本文详细讨论了基于FPGA和可编程增益放大器(PGA)实现的自动增益控制宽带视频放大器的设计及实现方法。首先给出了自动增益控制宽带放大器取样反馈、数字控制部分的多种实现方案,并根据实际应用情况及性能指标要求进行了方案论证。接着,分别介绍了模拟通道部分、数字取样模块、FPGA逻辑控制模块及数模转换模块,包括它们的芯片选择、实现方法和注意事项等。最后,对FPGA逻辑控制模块进行了功能分解,并以XilinxISE和Modelsim为开发平台完成了其子模块的程序设计及相关阶段的仿真。 本文实现的电路板可对带宽达40M的信号进行平稳的放大并输出较平坦的信号波形。同时,该电路板具有自动增益及固定增益选择能力。当选择自动增益方式时,增益的改变通过增益同步脉冲触发,触发脉冲可由系统内部周期产生或外部提供。
上传时间: 2013-06-05
上传用户:acon
目前运动控制主要有两种实现方式,一是使用PLC加运动控制模块来实现:二是使用PC加运动控制卡来实现。两者各有优缺点,但两者有以下共同的缺点:一是由于它们儿乎都是采用通用微控制器(MCU和DSP)来实现电机控制,由于受CPU速度的限制,以及CPU的多个进程同时处理,故无法在控制精度和控制速度比较高的场合中应用。二是它们的设计只是把运动控制部件当作系统的一个部分,如果要完成一个机械设备的完整控制,还需要辅助有其他的数字量/模拟量控制设备。这样在提高了系统成本的同时,也降低了系统的可靠性。 论文设计了一种基于ARM+CPLD的高速运动控制器,该控制器采用高速的CPLD处理器来完成电机的闭环控制,辅助以NXP的32位ARM7TDMI处理器LPC231X来实现复杂的运动规划,使得运动控制精度更高、速度更快、运动更加平稳;同时为系统扩展了常规运动控制卡不具备的通用I/O接口,除开4轴运动控制所需要的8点高速脉冲输入和8点高速脉冲输出外,系统具有24点数字量输入(可选共阴或共阳),25点继电器输出,仅一台这样的专用设备就可以完成4轴运动控制和设备上其它开关量控制。 系统采用可移植的软、硬件设计。硬件上以运动控制部件为核心,可以方便的在ARM处理器预留的资源上扩展出数字输入,数字输出,AD输入,DA输出等常用功能模块。系统软件构架如下:在最上层,系统采用μC/OS-Ⅱ操作系统来完成系统任务调度;在底层,将底层设备的操作打包编写成底层驱动的形式,可直接供用户程序调用;在中间层,可根据不同的用户要求编写用户程序,再将其传递给μC/OS-Ⅱ来调度该用户程序。 将该运动控制器应用于工业应用中的套标机,在对套标机进行运动分解之后,结合套标机的电气特性,很好的实现了运动控制器在套标机上的二次开发,满足了套标机在现场中的应用。
上传时间: 2013-04-24
上传用户:牛津鞋
rsghfsd
上传时间: 2013-10-31
上传用户:mahone
微型计算机课程设计论文—通用微机发声程序的汇编设计 本文讲述了在微型计算机中利用可编程时间间隔定时器的通用发声程序设计,重点讲述了程序的发声原理,节拍的产生,按节拍改变的动画程序原理,并以设计一个简单的乐曲评分程序为引子,分析程序设计的细节。关键字:微机 8253 通用发声程序 动画技术 直接写屏 1. 可编程时间间隔定时器8253在通用个人计算机中,有一个可编程时间间隔定时器8253,它能够根据程序提供的计数值和工作方式,产生各种形状和各种频率的计数/定时脉冲,提供给系统各个部件使用。本设计是利用计算机控制发声的原理,编写演奏乐曲的程序。 在8253/54定时器内部有3个独立工作的计数器:计数器0,计数器1和计数器2,每个计数器都分配有一个断口地址,分别为40H,41H和42H.8253/54内部还有一个公用的控制寄存器,端地址为43H.端口地址输入到8253/54的CS,AL,A0端,分别对3个计数器和控制器寻址. 对8353/54编程时,先要设定控制字,以选择计数器,确定工作方式和计数值的格式.每计数器由三个引脚与外部联系,见教材第320页图9-1.CLK为时钟输入端,GATE为门控信号输入端,OUT为计数/定时信号输入端.每个计数器中包含一个16位计数寄存器,这个计数器时以倒计数的方式计数的,也就是说,从计数初值逐次减1,直到减为0为止. 8253/54的三个计数器是分别编程的,在对任一个计数器编程时,必须首先讲控制字节写入控制寄存器.控制字的作用是告诉8253/54选择哪个计数器工作,要求输出什么样的脉冲波形.另外,对8253/54的初始化工作还包括,向选定的计数器输入一个计数初值,因为这个计数值可以是8为的,也可以是16为的,而8253/5的数据总线是8位的,所以要用两条输出指令来写入初值.下面给出8253/54初始化程序段的一个例子,将计数器2设定为方式3,(关于计数器的工作方式参阅教材第325—330页)计数初值为65536. MOV AL,10110110B ;选择计数器2,按方式3工作,计数值是二进制格式 OUT 43H,AL ; j将控制字送入控制寄存器 MOV AL,0 ;计数初值为0 OUT 42H,AL ;将计数初值的低字节送入计数器2 OUT 42H,AL ;将计数初值的高字节送入计数器2 在IBM PC中8253/54的三个时钟端CLK0,CLK1和CLK2的输入频率都是1.1931817MHZ. PC机上的大多数I/O都是由主板上的8255(或8255A)可编程序外围接口芯片(PPI)管理的.关于8255A的结构和工作原理及应用举例参阅教材第340—373页.教材第364页的”PC/XT机中的扬声器接口电路”一节介绍了扬声器的驱动原理,并给出了通用发声程序.本设计正是基于这个原理,通过编程,控制加到扬声器上的信号的频率,奏出乐曲的.2.发声程序的设计下面是能产生频率为f的通用发声程序:MOV AL, 10110110B ;8253控制字:通道2,先写低字节,后写高字节 ;方式3,二进制计数OUT 43H, AL ;写入控制字MOV DX, 0012H ;被除数高位MOV AX, 35DEH ;被除数低位 DIV ID ;求计数初值n,结果在AX中OUT 42H, AL ;送出低8位MOV AL, AHOUT 42H,AL ;送出高8位IN AL, 61H ;读入8255A端口B的内容MOV AH, AL ;保护B口的原状态OR AL, 03H ;使B口后两位置1,其余位保留OUT 61H,AL ;接通扬声器,使它发声
上传时间: 2013-10-17
上传用户:sunjet
为有效控制固态功率调制设备,提高系统的可调性和稳定性,介绍了一种基于现场可编程门阵列( FPGA)和微控制器(MCU) 的多路高压IGBT 驱动触发器的设计方法和实现电路。该触发器可选择内或外触发信号,可遥控或本控,能产生多路频率、宽度和延时独立可调的脉冲信号,信号的输入输出和传输都使用光纤。将该触发器用于高压IGBT(3300 V/ 800 A) 感应叠加脉冲发生器中进行实验测试,给出了实验波形。结果表明,该多路高压IGBT驱动触发器输出脉冲信号达到了较高的调整精度,频宽’脉宽及延时可分别以步进1 Hz、0. 1μs、0. 1μs 进行调整,满足了脉冲发生器的要求,提高了脉冲功率调制系统的性能。
上传时间: 2013-10-22
上传用户:zhulei420
为有效控制固态功率调制设备,提高系统的可调性和稳定性,介绍了一种基于现场可编程门阵列( FPGA)和微控制器(MCU) 的多路高压IGBT 驱动触发器的设计方法和实现电路。该触发器可选择内或外触发信号,可遥控或本控,能产生多路频率、宽度和延时独立可调的脉冲信号,信号的输入输出和传输都使用光纤。将该触发器用于高压IGBT(3300 V/ 800 A) 感应叠加脉冲发生器中进行实验测试,给出了实验波形。结果表明,该多路高压IGBT驱动触发器输出脉冲信号达到了较高的调整精度,频宽’脉宽及延时可分别以步进1 Hz、0. 1μs、0. 1μs 进行调整,满足了脉冲发生器的要求,提高了脉冲功率调制系统的性能。
上传时间: 2013-10-17
上传用户:123456wh
文中阐述一种移动机器人SLAM问题的解决方法,首先利用激光测距仪得到环境中障碍物的监测图表,然后增量的构建全局地图。利用扩展卡尔曼滤波器(EKF)创建移动机器人定位计算的有界估量;最后通过仿真和物理实验验证了该方法的正确性。可为解决机器人在未知环境下的地图创建与定位问题提供理论依据,具有实际意义。
上传时间: 2013-10-28
上传用户:jackandlee