硕士论文光纤陀螺视线稳定系统的设计与工程实现第章工程实现

第四章工程实现FOGSS是一个精密的机电系统装置。通过工程 设计 领导形象设计圆作业设计ao工艺污水处理厂设计附属工程施工组织设计清扫机器人结构设计 工作，基本完成了前阶段预期期间的工程要求，同时发现了一些技术上的问题。本章将就硬件配置、控制系统综合、软件设计展开讨论。硬件组成硬件系统的基本框图如图4-1所示。系统由从结构上由两大块组成：外框架回路（组件名称上标注1）和内框架回路（组件名称上标注2），内环对外环有耦合作用，为了设计方便，通过光电编码器对环架进行了解耦。这样，每个环架实现了单入单出，并且环架的控制律的设计是类似的。在硬件设计上，作了以下考虑：采用工业PC和运动控制卡GO400组成控制计算机系统。这样可以避免设计繁杂的硬件电路，并且可以使用PC机功能齐全的软件系统，便于软件编程和系统调试。采用Compumotor公司的直接驱动方式的无刷直流电机作为执行器。直接驱动电机的精度较高，而且可以实现传动链的简化和结构的简化，避免复杂的传动机构带来的机械加工误差。系统的两级安全保护：为防止控制作用处理失误造成相机和整个框架受损，设置两级限位装置对系统进行保护。第一级为光电型行程开关，当系统超出工作范围时由软件进行故障处理，第二级为机械式挡块，阻止框架连续旋转而绞断电机信号传输电缆。云台框架初始化的硬件保证：为了尽可能的减小稳定系统两框架之间的耦合，需要每次启动系统自动校零。由于基座伺服回路的位置传感器为增量式光电编码器，因而在硬件设计上采用光电行程开关帮助云台系统回到理想的初始位置（相机LOS的水平位置）。IPCBDDM2Encoder2Frame2GO-400MotioncontrollerBDDM1Encoder1Frame1FOG1FOG2图4-1FOGSS的结构Figure4-1thestructureofFOGSS图中IPC：研华工控机；GO400：运动控制卡；BDDM1、BDDM2：Compumotor公司的无刷直接驱动电机DM1030B（外环）和DM1015B（内环）；FOG1、FOG2：KVH公司数字输出开环光纤陀螺Ecore2000；Encoder1、Encoder2：电机内嵌的增量式光电编码器；Frame1、Frame2：云台的外框架和内框架；数字PID控制控制系统综合是系统设计的核心部分。需要考虑的控制律和运动控制有：稳定回路的控制基座伺服回路控制方位自动校零俯仰自动校零基座伺服回路与稳定回路的相互切换由于稳定回路是系统的核心部分，我们仅仅讨论稳定回路设计。有了前面的模型处理工作之后，我们就可以进行控制器设计了。设计掌握的基本原则是：结构简单，调试方便；下面，我们具体的就每个回路分别讨论。控制系统综合是针对简化模型的，由第二章的系统分析，我们可以得到稳定回路的简化模型如下图所示。此时摩擦力矩先假定为一个干扰。图4-2稳定回路控制系统综合用框图Figure4-2simplifieddiagramofstabilizationloopusedforcontrolsystemsynthesis1.PID控制器设计设计框图如图4-2所示。名义对象Gp(s)＝（4－1）其z传函为Gp(z)＝Zzoh（Gp(s)）==（4－2）式中K=＝（4－3）考虑光纤陀螺的一拍延迟，则整个系统的开环z传函为Go(z)=（4－4）采用w变换[18]，z＝或w＝（4－5）Go(w)=（4－6）Go(jv)=（4－7）校正前系统的对数频率特性如图4-3所示，图4-3校正前的系统的对数频率特性Figure4-3frequencycharacteristicsbeforecontrolsystemsynthesis系统对斜坡角度率信号响应是有差的，为了消除位置误差和提高增益，采用迟后校正，为了调试方便，设计中采用基本II型系统，故可取校正函数：Gc(w)=（4－8）取w1＝10rad/s，Kc=＝244，此时带宽约为20rad/s，在调试时应在线调整这两个参数。校正后的对数频率特性如图4-4所示，图4-4校正后系统的开环对数频率特性Figure4-4frequencycharacteristicsaftercontrolsystemsynthesis将校正函数变换到z域，Gc(z)=（4－9）系统对指令角速度的阶跃响应和斜坡响应如图4-5所示，在仿真中考虑了执行器饱和对系统的影响。图4-5校正后系统对角速度信号()的阶跃响应Figure4-5stepresponsetoanglevelocityinputaftercontrolsystemsynthesis2.外环轴干扰力矩的影响干扰力矩的作用形式干扰力矩是影响平台稳定精度的主要因素。在外环，干扰力矩的主要形式是基座和外框架轴之间的摩擦耦合。其作用规律与基座的摇摆角速度有关。设基座的摇摆规律为（4－10）为了定量的分析摩擦力矩对系统的影响，忽略动静摩擦的差异，不考虑摩擦力矩的Stribeck效应，将摩擦力矩建模为=－Mimsign(ωt)(－π<ωt<+π)（4－11）其Fourier展开级数为＝（4－12）上式 表 关于同志近三年现实表现材料材料类招标技术评分表图表与交易pdf视力表打印pdf用图表说话 pdf 明，摩擦力矩的频谱取决于基座摇摆角速度的频谱。因此，分析载体的振动频谱对于确定系统稳定回路的低频带宽有重要的指导意义。系统对常值干扰力矩的响应校正后系统以角速度为输出的开环传函可表示为：Gco(w)==G1(w)（4－13）设常值干扰力矩为=M/w（4－14）设干扰力矩幅值为M=，由图4-2可得ω(w)==Gω(w)M(w)=M(w)（4－15）＝Gθ(w)M(w)=M(w)（4－16）根据终值定理，ω（∞）＝=0（4－17）（∞）＝=M==（4－18）系统对周期性干扰力矩的响应设干扰力矩为=Msgn(vt)（4－19）由频率响应的基本概念，系统稳态时的输出应为ω(t)＝Msin[vt+phase(Gω(jv))（4－20）θ(t)＝Msin[vt+phase(Gθ(jv))（4－21）忽略高频小参数，只考虑系统的第一个转折频率，可得ω(t)=Msin[vt+phase(Gω(jv))（4－22）θ(t)＝Msin[vt+phase(Gθ(jv))（4－23）由以上分析可以得出系统的刚度与开环增益和转子的转动惯量成正比。系统在常值干扰力矩下，稳态时有一个微小的转角。在干扰力矩作用下，系统无长期角速度漂移。当平台的基座振动角速度分别为ω＝，1Hz，10Hz时，假定摩擦力矩最大为，则输出角速度曲线如图4-6~4-8所示，输出角度曲线如图4-9~4-11所示：图4-6ω＝时的输出角速度Figure4-6anglevelocityoutputwhenω＝图4-7ω＝1Hz时的输出角速度Figure4-7anglevelocityoutputwhenω＝1Hz图4-8ω＝10Hz时的输出角速度Figure4-8anglevelocityoutputwhenω＝10Hz图4-9ω＝时的输出角度Figure4-9angleoutputwhenω＝图4-10ω＝1Hz时的输出角度Figure4-10angleoutputwhenω＝1Hz图4-11ω＝10Hz时的输出角度Figure4-11angleoutputwhenω＝10Hz从仿真结果可以看到，利用基本Ⅱ型控制系统，平台在不同基座摇摆角速度作用下的性能非常接近，这说明，将稳定回路设计为基本Ⅱ型伺服系统，对基座的摩擦力矩干扰频率的变化抑制有很好的适应性。3.陀螺仪噪声对平台系统的影响设线性系统的输入随机信号为ω(t)，输出为y(t)，从ω(s)到y(s)的闭环传函为C(s)，则系统的输出谱密度和输入谱密度的关系由下式给出[19]：φy(v)＝φω(v)（4－24）输出均方误差为（4－25）陀螺仪输出的噪声可以近似等效为一个白噪声，其统计特性表示为：R(τ)＝σ2δ(τ)（4－26）谱密度为φ(v)＝σ2（4－27）在白噪声作用下，系统的性能采用等效噪声带宽来表征。考虑系统的输出角速度低频模型，Gco(w)≈（4－28）其闭环传函为C(w)＝（4－29）所以白噪声作用下输出角速度均方误差为：＝2πσ2（4－30）其等效角速率噪声带宽为：ωb＝π（4－31）当w1很小或很大时，系统的噪声都很大，若w1＝（4－32）此时等效噪声带宽最小，为ωb＝（4－33）设计中，陀螺仪输出噪声方差为σ2＝×10－8(rad/s)2（4－34）设计的第一个转折频率为w1＝10rad/s，开环增益为Kc＝200，＝30πσ2＝×10－8(rad/s)2（4－35）＝s＝s=h（4－36）现在分析噪声对轴角度输出的影响。类似的，从ω(s)到位置角度的传函为H(w)＝（4－37）输出角度均方误差为（其中BW为光纤陀螺带宽）（4－38）我们对系统噪声影响做了仿真，其结果如图4-12所示。图4-12FOG噪声输入时的角度输出响应曲线（3600秒）Figure4-12FOGoutputangleresponsewithnoiseinput可以看到，仿真与计算结果是一致的。综合以上计算分析和仿真，可以得出如下结论：陀螺仪的噪声影响平台的短期精度和长期漂移指标。在短的时间内，陀螺仪噪声将引起平台输出轴的颤振。在长时间内，陀螺噪声将使输出轴的角度振荡发散。内环PID控制器设计与外环相比，存在以下特有问题：1.质量不平衡偏心干扰力矩平台质量不平衡引起的偏心力矩对系统也有一定的影响，设平台内环转动部分的质量为m，质心偏离支承的距离为r，m则当基座的摇摆角速度如式（4-10）所示，则表达式可：Md=－mgr－mr2（4－39）可以看到，偏心力矩分为两部分，一部分为常值干扰力矩，另一部分为周期干扰力矩，它们在内环轴输出产生的转角如式（4-18）和（4-21）所示。转动惯量的变动由表2-1可以看到，由于负载的变化，引起了外环和内环转动惯量的改变，外环转动惯量的波动是相当小的，为1/6，对于这么小的变动，利用PID 方法 快递客服问题件处理详细方法山木方法pdf计算方法pdf华与华方法下载八字理论方法下载 设计后的系统对该变化有足够的适应性。而内环则变化幅度为47％，所以设计后的系统应该检验系统增益在该范围变化后的性能。若不行，就不能采用单独的PID设计。以下采用仿真的方法校验了系统的性能。PID控制器检验类似的可设计内环PID控制器为Gci(w)=（4－40）其中Kci＝162，w1=10rad/s（4－41）变换到z域后为Gci(z)=（4－42）当转动惯量分别为和时的干扰响应和指令角速度响应如图4-13~4-16所示（设基座摇摆角速度为，摩擦干扰力矩最大为）。图4-13ω＝时的干扰力矩作用下的输出角度响应（惯量为）Figure4-13outputangleresponsetoinputfrictiondisturbancewhenω＝(withmomentofinertia图4-14指令角速度的阶跃响应(ωr=20deg/s)（惯量为）Figure4-14stepresponsetoinputcommandanglevelocity(withmomentofinertiabeing图4-15ω＝时的干扰力矩输出角度响应（惯量为）Figure4-15outputangleresponsetoinputfrictiondisturbancewhenω＝(withmomentofinertiabeing图4-16指令角速度的阶跃响应(ωr=20deg/s)（惯量为）Figure4-13stepresponsetoinputcommandanglevelocity(withmomentofinertia由上面可以看到，增益变化后系统性能并没有太大的变化，这也可以从bode图上可以看出：采用典型Ⅱ型系统设计时，系统的相频特性在剪切频率附近变化缓慢，故当增益在较大范围内上升时，系统的相位裕度变化不大，因而转动惯量变化对系统性能的影响不大。A/D量化噪声的影响FOG的输出角速度经过A/D量化后编程数字量，由于有限字长将导致量化误差。设q为量化阶，即LSB，其数值为：q＝。量化误差因量化方法的不同而互异。该误差可等效的作为FOG的输出噪声在系统回路中放大，从而出现在输出端。由数字控制理论得知：截尾量化噪声的统计特性为均值：＝＝（4－43）方差：σ＝＝×10－10(rad/s)2（4－44）舍入量化噪声的统计特性为均值：＝0（4－45）方差：σ＝＝×10－10(rad/s)2（4－46）可以看到，它比FOG本体产生的噪声小两个数量级，在设计中可以忽略。软件设计设计中软件采用BorlandC++语言实现[20][21]。对于一个高精度的机电系统，如何在确保设备的安全性的前提下顺利调试是一个相当重要的问题。因此，除了在硬件上做一些必要的安全处理 措施 《全国民用建筑工程设计技术措施》规划•建筑•景观全国民用建筑工程设计技术措施》规划•建筑•景观软件质量保证措施下载工地伤害及预防措施下载关于贯彻落实的具体措施 之外，还在软件规划中做了一些必要的故障诊断和处理。软件所需实现的主要任务系统自检和故障诊断和处理FOGSS是一个精密的机电设备，为了使系统维护方便，除了硬件上做一些措施外，在软件里做了一些必要的容错处理。这些包括：运动控制卡、FOG、电机驱动器的自检。在启动系统时，必须检测元器件是否正常工作，否则有可能因元器件故障而使系统受损。系统故障报警和处理。当有故障发生时，软件能检测出该故障，并诊断其故障类型，从而做出必要的处理。主要的故障有：电机过速电机过载云台撞到限位开关驱动器工作不正常事故急停处理：当一旦有事故发生时，系统应该立即关闭，力求将事故对系统的破坏降低到最低程度。光纤陀螺仪角速率采集程序通过串口中断处理程序，实时采集和组合FOG的数据。自动校零为了使系统在基座伺服回路工作时有一个合适的参考基准，并为两个框架解耦，系统工作时应该自动校零，找到机械原点(Home)，以此作为系统工作的参照点。基座电锁定控制正常工作情况下，由于稳定回路工作时系统的稳定裕度较低，为了避免环架在载体大机动时受损，系统处于基座电锁定状态，此时陀螺仪不起作用，电机伺服回路由光电编码器来闭环。陀螺仪温度漂移补偿利用测试和实验得来的模型，降低温度对FOG的漂移的影响。平台稳定当需要稳定时，通过指令将环架切换到稳定状态，使环架的运动与基座的角运动隔离。2.软件流程软件主要包括三大块：主程序：包括初始化，安装中断向量，系统自检，接收命令等。串口中断服务程序：读取FOG传输到串口缓冲区的数据，组成台体相对惯性空间的角速度，并由此计算稳定调节控制律，送给执行电机，使台体相对惯性空间保持稳定。定时器中断服务程序：采集光电编码器的数据，组成台体相对基座的角速度和角位移，由此计算基座伺服控制律，送给执行电机，使平台自动校零或相对基座电锁定。以下是程序流程。图4-17定时器中断服务程序流程Figure4-17flowchartofTimerISR图4-18主程序工作流程Figure4-18flowchartofmainprocedure图4-19稳定回路和串口中断服务程序流程Figure4-19flowchartofstabilizationprocedureandserialportISR本章小结本章从工程的角度比较完整的讨论了FOGSS的数字PI控制系统综合和软硬件实现。控制系统综合所用的模型必须是简化的模型，这样可以抓住关键，并且所设计的控制器实现简单，从而在调试起来也比较方便，由此可以发现系统中的一些不确定问题。控制系统综合后，对误差源影响进行了一些解析计算和仿真估计。在软件和硬件处理中则是考虑了系统的容错设计，从而为系统的调试提供安全的保障。实际运行与理论上的计算是一致的。后来通过测试表明，外环的库仑摩擦力矩幅值大小为，由此引起的稳定误差在（）。在调试中由于内环的摩擦力矩比较大，所以采用了混和式稳定系统配置方式。