导航原理作业（惯性导航部分）
一、题目内容
一枚导弹采用捷联惯性导航系统，三个速率陀螺仪Gx, Gy, Gz和三个加速度计Ax, Ay, Az的敏感轴分别沿着着弹体坐标系的Xb, Yb, Zb轴。初始时刻该导弹处在北纬45.75度，东经126.63度。
第一种情形：正对导弹进行地面静态测试（导弹质心相对地面静止）。
初始时刻弹体坐标系和地理坐标系重合，如图所示，弹体的Xb轴指东，Yb轴指北，Zb轴指天。此后弹体坐标系Xb-Yb-Zb相对地理坐标系的转动如下：
首先，弹体绕Zb（方位轴）转过-10 度；
接着，弹体绕Xb（俯仰轴）转过15 度；
然后，弹体绕Yb（滚动轴）转过20 度；
最后弹体相对地面停止旋转。
请分别用方向余弦矩阵和四元数两种方法计算：弹体经过三次旋转并停止之后，弹体上三个加速度计Ax, Ay, Az的输出。取重力加速度的大小g = 9.8m/s2。
第二种情形：导弹正在飞行中。
初始时刻弹体坐标系仍和地理坐标系重合；且导弹初始高度200m，初始北向速度1800 m/s，初始东向速度和垂直速度都为零。
陀螺仪和加速度计的输出都为脉冲数形式，陀螺输出的每个脉冲代表0.00001弧度的角增量。加速度计输出的每个脉冲代表1μg，1g = 9.8m/s2。陀螺仪和加速度计输出的采样频率都为10Hz，在200秒内三个陀螺仪和三个加速度计的输出存在了数据文件gaout.mat中，内含一矩阵变量ga，有2000行，6列。每一行中的数据代表每个采样时刻三个陀螺Gx, Gy, Gz
将地球视为理想的球体，半径6371.00公里，且不考虑仪表误差，也不考虑弹体高度对
重力加速度的影响。选取弹体的姿态计算周期为0.1秒，速度和位置的计算周期为1秒。
（1） 请计算200秒后弹体到达的经纬度和高度，东向和北向速度； （2） 请计算200秒后弹体相对当地地理坐标系的姿态四元数；
（3） 请绘制出200秒内导弹的经、纬度变化曲线（以经度为横轴，纬度为纵轴）； （4） 请绘制出200秒内导弹的高度变化曲线（以时间为横轴，高度为纵轴）。
二、第一种情形解答
2.1方向余弦阵法
（1） 先绕b Z 轴转过0
10ψ=-
00
00cos()sin()0cos(10)sin(10)0sin()cos()0sin(10)cos(10)0001001C ψψψψψ??
--??
? ?=-=--- ?
? ? ?????
（2） 再绕
b X 轴转过015θ=
00001001000cos()sin()0cos(15)sin(15)0sin()cos()0sin(15)cos(15)C θθθθθ???? ? ?== ? ?
? ?--????
（3） 再绕b Y 轴转过0
20?=
00
00cos()0sin()cos(20)0sin(20)010010sin()0cos()sin(20)0cos(20)C ???????
--??
? ?== ?
? ? ?????
所以变换后的坐标
X E Y C C C N Z ?θψζ???? ?
?= ? ? ? ???
??
由于初始时刻有
009.8E N ζ???? ? ?= ? ? ? ?????
所以计算得
3.23762.53648.8952X Y Z -???? ? ?= ? ? ? ?????
弹体上三个加速度计的输出分别是
3.2376X A =-， 2.5364Y A =，8.8952Z A =
计算程序见附录一
2.2四元数法
（1）先绕b Z 轴转过0
10ψ=-
cos()sin cos()sin 2222q n k
ψψ
ψψ
ψ=+=+
（）（）
（2）再绕b X 轴转过015θ=
cos()sin cos()sin 2222q n i θθ
θθ
θ=+=+
（）（）
（3）再绕b Y 轴转过0
20?=
cos()sin cos()sin 2222q n j
??
??
?=+=+
（）（）
则合成四元数
123q q q q p i p j p k
ψθ?λ==+++
合成四元数的逆
1
123q p i p j p k λ-=---
计算得
0.97460.14310.16030.0625q i j k =++-
1
0.97460.14310.16030.0625q i j k -=--+
由
1
R q Rq -'=及 R xi y j zk =++
R x i y j z k ''''=++ 得
2222
1231231322222
1231232312222132231123()
2()2()2()()2()2()2()()x p p p p p p p p p x y p p p p p p p p p y z p p p p p p p p p z λλλλλλλλλ'??+--+-???? ? ? ?'=--+-+ ? ? ? ? ? ?'+---+??????
其中
009.8x R y z ????
? ?== ? ?
? ?????
所以计算得
3.23762.53648.8952x R y z '-???? ? ?''== ? ?
? ?'????
弹体上三个加速度计的输出分别是
3.2376X A =-， 2.5364Y A =，8.8952Z A =
由两种计算方法的计算结果可以看出，方向余弦阵法和四元数法的计算结果是一致的。 计算程序见附录二
三、第二种情形解答
3.1 程序流程图
3.2 matlab 程序见附录三
3.3 程序运算结果及仿真图
在200秒后，弹体到达的经度为128.149度，到达的纬度为48.897度，导弹所到达的高度为84.504米，200秒时的东向速度为1123.96米每秒，北向速度为1568.016米每秒。 200秒后弹体相对当地地理坐标系的姿态四元数为：
0.95060.0106=0.00480.3101Q ?? ?
? ?- ?-??
导弹飞行过程中的经纬度变化曲线如图1所示：
图1 导弹飞行过程中经度纬度变化曲线
126.6
126.8127127.2
127.4127.6
127.8128128.2128.4
45.5
4646.54747.5
48
48.5
49
经度
纬度
经纬度曲线
导弹飞行过程中高度变化曲线如图2：
图2 导弹飞行过程中高度变化曲线
3.4 程序仿真中遇到的问题及体会
在按照程序流程图编程时，由于把某些公式的正负号写错，导致在程序仿真时出现了图3的结果。
图3 仿真遇到的问题
020406080
100120140160180200
80
100
120
140
160
180
200
时间
高度
高度变化曲线
020406080
100120140160180200
50010001500
2000
2500
时间
高度
高度变化曲线
在程序仿真中遇到的另一个问题是在计算四元数阵时，把四元数的维数弄错，导致程序运行出错。
在编写程序时，四元数的初始化非常重要，如果四元数的初始化错误，会导致所有的运算结果错误。某些子函数的调用实参与虚参要一致，子函数的返回值要符合需要的格式。
同时，这次编程，让我学会了很多以前没用到的matlab函数，在编程过程中，每当遇到问题，我就会上网查一些资料，学习并解决问题。这在很大程度上提高了我的自学能力。
附录一
suan.m
C1=[cos(-10/180*pi) sin(-10/180*pi) 0
-sin(-10/180*pi) cos(-10/180*pi) 0
0 0 1]; %第一次转动方向余弦阵
C2=[1 0 0
0 cos(15/180*pi) sin(15/180*pi)
0 -sin(15/180*pi) cos(15/180*pi)];
%第二次转动方向余弦阵
C3=[cos(20/180*pi) 0 -sin(20/180*pi)
0 1 0
sin(20/180*pi) 0 cos(20/180*pi)];
%第三次转动方向余弦阵
A=C3*C2*C1*[0;0;9.8] %计算转动后弹体上加速度的输出
norm(A) %检验输出是否正确
附录二
suanfa.m
q1=[cos(-10/360*pi);0;0;sin(-10/360*pi)];%第一次转动四元数
q2=[cos(15/360*pi);sin(15/360*pi);0;0];%第二次转动四元数
q3=[cos(20/360*pi);0;sin(20/360*pi);0];%第三次转动四元数
r=quml(q1,q2);%计算四元数乘积
q=quml(r,q3);
A1=[q(1) q(2) q(3) q(4)
-q(2) q(1) q(4) -q(3)
-q(3) -q(4) q(1) q(2)
-q(4) q(3) -q(2) q(1)]
A2=[q(1) -q(2) -q(3) -q(4)
q(2) q(1) q(4) -q(3)
q(3) -q(4) q(1) q(2)
q(4) q(3) -q(2) q(1)]
A=A1*A2;%
G=A*[0;0;0;9.8] %计算转动后的弹体加速度计的输出
附录三
%m文件名jlgd.m
clc;
clear;
%------已知参数--------------------------------------------%
k=10;
T=1;
K=200;
R=6371000;
We=15/180*pi/3600;
%初始导航参数和地球参数-----------------------%
Q=zeros(4,201); %定义变换四元数矩阵
Lamda = zeros(1,201);%定义长度为200的经度数组
Fai=zeros(1,201); %定义长度为200的纬度数组
H=zeros(1,201); %定义长度为200的高度数组
Q(:,1)=[1;0;0;0]; %初始化四元数
Lamda(1)=126.63; %初始化经度
Fai(1)=45.75;%初始化纬度
H(1)=200; %初始化高度
g=9.8;
%------------------------------------------------------%
%定义速度矩阵，供画图用
Ve_Matrix = zeros(1,201); %东向速度
Vn_Matrix = zeros(1,201); %北向速度
Vu_Matrix = zeros(1,201); %天向速度
Ve_Matrix(1)=0;
Vn_Matrix(1)=1800;
Vu_Matrix(1)=0;
%--------------------%定义加速度矩阵-------------------
FE_Matrix = zeros(1,201); %东向加速度
FN_Matrix = zeros(1,201); %北向加速度
FU_Matrix = zeros(1,201); %天向加速度
loadgaout.mat
for N=1:K %位置、速度迭代
q1=zeros(4,11);
q1(:,1)=Q(:,N);
for n=1:k %姿态迭代
WX=0.00001*ga((N-1)*10+n,1);
WY=0.00001*ga((N-1)*10+n,2);
WZ=0.00001*ga((N-1)*10+n,3);
w=[WX,WY,WZ]';
normw=norm(w);
W=[0,-w(1),-w(2),-w(3);
w(1),0,w(3),-w(2);
w(2),-w(3),0,w(1);
w(3),w(2),-w(1),0];
I=eye(4);
%三阶近似
S=1/2-normw^2/48;
C=1-normw^2/8;
q1(:,n+1)=(C*I+S*W)*q1(:,n);
end
Q(:,N+1)=q1(:,n+1);
WE=-Vn_Matrix(N)/R; %地理坐标系的转动角速度分量
WN=Ve_Matrix(N)/R+We*cos(Fai(N)/180*pi);
WH=Ve_Matrix(N)/R*tan(Fai(N)/180*pi)+We*sin(Fai(N)/180*pi);
gama=[WE,WN,WH]'*T; %用地理坐标系的转动四元数
normgama=norm(gama); %修正载体姿态四元数
n=gama/normgama;
QG=[cos(normgama/2);sin(normgama/2)*n];
Q(:,N+1)=quml(qiuni(QG),Q(:,N+1));
FX=1e-6*9.8*mean(ga((N-1)*10+1:N*10,4)); %加速度计测得的比力
FY=1e-6*9.8*mean(ga((N-1)*10+1:N*10,5));
FZ=1e-6*9.8*mean(ga((N-1)*10+1:N*10,6));
Fb=[FX FY FZ]';
F=quml(Q(:,N+1),quml([0;Fb],qiuni(Q(:,N+1))));%将比力分解到地理坐标系
FE(N)=F(2);FN(N)=F(3);FU(N)=F(4);
%---------计算载体的相对加速度-------------%
VED(N)=FE(N)+Ve_Matrix(N)*Vn_Matrix(N)/R*tan(Fai(N)/180*pi)-(Ve_Matrix(N)/R+2*We*c
os(Fai(N)/180*pi))*Vu_Matrix(N)+2*Vn_Matrix(N)*We*sin(Fai(N)/180*pi);
VND(N)=FN(N)-2*Ve_Matrix(N)*We*sin(Fai(N)/180*pi)-Ve_Matrix(N)*Ve_Matrix(N)/R*tan(F ai(N)/180*pi)-Vn_Matrix(N)*Vu_Matrix(N)/R;
VUD(N)=FU(N)+2*Ve_Matrix(N)*We*cos(Fai(N)/180*pi)+(Ve_Matrix(N)^2+Vn_Matrix(N)^2)/ R-g;
%---------积分计算载体的相对速度---------%
Ve_Matrix(N+1)=VED(N)*T+Ve_Matrix(N);
Vn_Matrix(N+1)=VND(N)*T+Vn_Matrix(N);
Vu_Matrix(N+1)=VUD(N)*T+Vu_Matrix(N);
%---------积分计算载体的位置------------%
Lamda(N+1)=Ve_Matrix(N)/R/cos(Fai(N)/180*pi)*T/pi*180+Lamda(N);
Fai(N+1)=Vn_Matrix(N)/R*T/pi*180+Fai(N);
H(N+1)=Vu_Matrix(N)*T+H(N);
end
%-----------画图部分---------------%
%绘制200 秒内导弹的经、纬度变化曲线（以经度为横轴，纬度为纵轴）；
figure(1)
hold on
grid on
plot(Lamda,Fai,'LineWidth',2);
xlabel('经度');
ylabel('纬度');
title('经纬度曲线');
%绘制200 秒内导弹的高度变化曲线（以时间为横轴，高度为纵轴)
figure(2)
hold on
grid on
plot([0:200],H,'LineWidth',2);
xlabel('时间');
ylabel('高度');
title('高度变化曲线');
%---------输出部分---------------%
str1='200秒后弹体到达的经度Lamda:';
fprintf(1,'%s%f\n',str1,Lamda(201));
str2='200秒后弹体到达的纬度Fai:';
fprintf(1,'%s%f\n',str2,Fai(201));
str3='200秒后弹体到达的高度H:';
fprintf(1,'%s%f\n',str3,H(201));
str4='200秒后弹体的东向速度Ve_Matrix:';
fprintf(1,'%s%f\n',str4,Ve_Matrix(201));
str5='200秒后弹体的北向速度Vn_Matrix:';
fprintf(1,'%s%f\n',str5,Vn_Matrix(201));
str6='200秒后弹体相对当地地理坐标系的姿态四元数Q:'; fprintf(1,'%s\n',str6);
Q=Q(:,201)
%四元数求逆函数
function [ qni ] = qiuni( q )
q(1)=q(1);
q(2)=-q(2);
q(3)=-q(3);
q(4)=-q(4);
qni=q;
end
%四元数相乘计算函数
function [q]=quml(q1,q2);
lm=q1(1);p1=q1(2);p2=q1(3);p3=q1(4);
q=[lm -p1 -p2 -p3;p1 lm -p3 p2;p2 p3 lm -p1;p3 -p2 p1 lm]*q2; end
卫星定位导航原理实验 班级：1105103班 学号：1110510304 姓名： 同组人： 2014年11月12日
实验一实时卫星位置解算及结果分析 一、实验原理 实时卫星位置解算在整个GPS接收机导航解算过程中占有重要的位置。卫星位置的解算是接收机导航解算（即解出本地接收机的纬度、经度、高度的三维位置）的基础。需要同时解算出至少四颗卫星的实时位置，才能最终确定接收机的三维位置。 对某一颗卫星进行实时位置的解算需要已知这颗卫星的星历和GPS时间。而星历和GPS 时间包含在速率为50比特/秒的导航电文中。导航电文与测距码（C/A码）共同调制L1载频后，由卫星发出。本地接收机相关接收到卫星发送的数据后，将导航电文解码得到导航数据。后续导航解算单元根据导航数据中提供的相应参数进行卫星位置解算、各种实时误差的消除、本地接收机位置解算以及定位精度因子（DOP）的计算等工作。关于各种实时误差的消除、本地接收机位置解算以及定位精度因子（DOP）的计算将在后续实验中陆续接触，这里不再赘述。 卫星的额定轨道周期是半个恒星日，或者说11小时58分钟2.05秒；各轨道接近于圆形，轨道半径（即从地球质心到卫星的额定距离）大约为26560km。由此可得卫星的平均角速度ω和平均的切向速度v s为： ω=2π/(11*3600+58*60+2.05)≈0.0001458rad/s (1.1) v s=rs*ω≈26560km*0.0001458≈3874m/s (1.2) 因此，卫星是在高速运动中的，根据GPS时间的不同以及卫星星历的不同（每颗卫星的星历两小时更新一次）可以解算出卫星的实时位置。本实验同时给出了根据当前星历推算出的卫星在11小时58分钟后的预测位置，以此来验证卫星的额定轨道周期。 本实验另一个重要的实验内容是对卫星进行相隔时间为1s的多点测量（本实验给出了三点），根据多个点的测量值，可以估计Doppler频移。 由于卫星与接收机有相对的径向运动，因此会产生Doppler效应，而出现频率偏移。Doppler频移的直接表现是接收机接收到的卫星信号不恰好在L1（1575.42MHz）频率点上，而是在L1频率上叠加了一个最大值为±5KHz左右的频率偏移，这就给前端相关器进行频域搜索，捕获卫星信号带来了困难。如果能够事先估计出大概的Doppler频偏，就会大大减小相关器捕获卫星信号的难度，缩短捕获卫星信号的时间，进而缩短接收机的启动时间。GPS 接收机的启动时间是衡量接收机性能好坏的重要参数之一，而卫星信号的快速捕获，缩短接收机的启动时间也是目前GNSS业界的热点问题。 本实验中Doppler频移的预测与后续《可视卫星位置预测》实验是紧密联系的，可视卫星位置预测中也包括对Doppler频移的预测。本实验将给出根据卫星位置和本地接收机的初始位置预测Doppler频移的方法。 有了卫星位置和本地接收机的初始位置，就可以根据空间两点间的距离公式，得出卫星距接收机的距离d。记录同一卫星在短时间t内经过的两点的空间坐标S1和S2，就可以分别得到这两点距接收机的距离d1和d2。只要相隔时间t取的较小（本实验取t=1s），|d1-d2|/t 就可以近似认为是卫星与接收机在t时间内的平均相对径向运动速度，再将此速度转换为频率的形式就可以得到大致的Doppler频移。 设本地接收机的初始位置为R（x r，y r，z r），记录的卫星两点空间坐标为S1（x1，y1，z1）、S2（x2，y2，z2），相隔时间为t，卫星与接收机平均相对径向运动速度为v d，光速为c，Doppler 频移为f d，则Doppler频移预测的具体公式如下所示： d1=[(x1-x r)2+(y1-yr)2+(z1-z r)2]1/2 (1.3) d2=[(x2-x r)2+(y2-y r)2+(z2-z r)2]1/2(1.4)
机械原理大作业 This model paper was revised by the Standardization Office on December 10, 2020
机械原理大作业三 课程名称：机械原理 设计题目：齿轮传动设计 院系： 班级： 设计者： 学号： 指导教师： 设计时间： 1、设计题目 机构运动简图 机械传动系统原始参数
2、传动比的分配计算 电动机转速min /745r n =，输出转速m in /1201r n =，min /1702r n =， min /2303r n ，带传动的最大传动比5.2max =p i ,滑移齿轮传动的最大传动比4m ax =v i ，定轴齿轮传动的最大传动比4m ax =d i 。 根据传动系统的原始参数可知，传动系统的总传动比为： 传动系统的总传动比由带传动、滑移齿轮传动和定轴齿轮传动三部分实现。设带传动的传动比为5.2max =p i ，滑移齿轮的传动比为321v v v i i i 、、，定轴齿轮传动的传动比为f i ，则总传动比 令 4max 1==v v i i 则可得定轴齿轮传动部分的传动比为 滑移齿轮传动的传动比为 设定轴齿轮传动由3对齿轮传动组成，则每对齿轮的传动比为 3、齿轮齿数的确定 根据滑移齿轮变速传动系统中对齿轮齿数的要求，可大致选择齿轮5、6、7、8、9和10为角度变位齿轮，其齿数： 35,18,39,14,43,111098765======z z z z z z ；它们的齿顶高系数1=* a h ，径向间 隙系数25.0=*c ，分度圆压力角020=α，实际中心距mm a 51'=。
一、 设计任务书 设计任务是考虑到飞机的姿态控制问题，姿态控制转换简化模型如图所示，当飞机以4倍音速在100000英尺高空飞行，姿态控制系统的参数分别为： 4,0.1,0.1,0.11 1====a a a K ωεωτ 设计一个校正网络(),s G c 使系统的阶跃响应超调量小于5%，调节时间小于5s （按2%准则）
2、计算机辅助设计 （1）simulink仿真框图 Simulink仿真框图 双击scope显示图像，观察阶跃相应是否达到指标
放大图像观察超调量为s t s p 7.4%,3==σ满足要求 （2）绘制bode 图
校正前的bode图 校正后的bode图
（3）绘制阶跃相应曲线 校正前的阶跃相应曲线 校正后的阶跃相应曲线
三、校正装置电路图 前面为放大装置放大25倍，后面为超前补偿电路，它自身的K 为0.1，相乘之 后为指标中的2.5，校正装置电路完成1 60 ) 16( 5.2++= s s G c 。 四、设计结论 设计的补偿网络为1 60 ) 16( 5.2++=s s G c 。经过仿真得出超调量为s t s p 7.4%,3==σ满足 要求。 五、设计后的心得体会 实际的控制系统和我们在书中看到的标准系统差别很大，参数的要求比书 中要求相对要苛刻，在设计校正网络的过程中，遇到很多困难超前滞后用根轨迹法无法求出，只能用simulink 画出仿真框图，通过经过一定的计算大概确定某些参数，通过不断地尝试修改，才能最终得到满足指标要求的阶跃相应曲线，很多时候现实中的参数没有书中的参数给的那么简单，会遇到很多难以想象的复杂状况，所以我们学习控制原理关键是学习怎么处理，如何应用好软件来配合完成系统的设计，现代控制理论不能单纯的通过简单的计算得出结论的，需要我们熟练运用软件来辅助设计，这样我们才能设计好一个校正网络。
《导航原理》作业 (惯性导航部分)
一、题目要求 A fighter equipped with SINS is initially at the position of ?35 NL ?122X G Y G Z G ,and three accelerometers, X A ,Y A ,Z A are installed along the axes b X ,b Y ,b Z of the body frame respectively. Case 1:stationary onboard test The body frame of the fighter initially coincides with the geographical frame, as shown in the figure, with its pitching axis b X pointing to the east,rolling axis b Y to the north, and azimuth axis b Z upward. Then the body of the fighter is made to rotate step by step relative to the geographical frame. (1) ?10around b X (2) ?30around b Y (3) ?50-around b Z After that, the body of the fighter stops rotating. You are required to compute the final output of the three accelerometers on the fighter, using both DCM and quaternion respectively,and ignoring the device errors. It is known that the magnitude of gravity acceleration is 2/8.9g s m =. Case 2:flight navigation Initially, the fighter is stationary on the motionless carrier with its board 25m above the sea level. Its pitching and rolling axes are both in the local horizon, and its rolling axis is ?45on the north by east, parallel with the runway onboard. Then the fighter accelerate along the runway and take off from the carrier. The output of the gyros and accelerometers are both pulse numbers,Each gyro pulse is an angular increment of sec arc 1.0-,and each accelerometer pulse is g 6e 1-,with 2/8.9g s m =.The gyro output frequency is 10 Hz,and
自动控制原理 大作业 （设计任务书） 姓名： 院系： 班级： 学号： 5. 参考图5 所示的系统。试设计一个滞后-超前校正装置，使得稳态速度误差常数为20 秒-1，相位裕度为60
度，幅值裕度不小于8 分贝。利用MATLAB 画出 已校正系统的单位阶跃和单位斜坡响应曲线。 + 一．人工设计过程 1.计算数据确定校正装置传递函数 为满足设计要求，这里将超前滞后装置的形式选为 ) 1)(() 1)(1()(2 12 1T s T s T s T s K s G c c ββ++++= 于是，校正后系统的开环传递函数为)()(s G s G c 。这样就有 )5)(1()(lim )()(lim 00++==→→s s s K s sG s G s sG K c c s c s v 205 ==c K 所以 100=c K 这里我们令100=K ，1=c K ，则为校正系统开环传函) 5)(1(100 )(++= s s s s G
首先绘制未校正系统的Bode 图 由图1可知，增益已调整但尚校正的系统的相角裕度为? 23.6504-，这表明系统是不稳定的。超前滞后校正装置设计的下一步是选择一个新的增益穿越频率。由)(ωj G 的相角曲线可知，相角穿越频率为2rad/s ，将新的增益穿越频率仍选为2rad/s ，但要求2=ωrad/s 处的超前相角为? 60。单个超前滞后装置能够轻易提供这一超前角。 一旦选定增益频率为2rad/s ，就可以确定超前滞后校正装置中的相角滞后部分的转角频率。将转角频率2/1T =ω选得低于新的增益穿越频率1个十倍频程，即选择2.0=ωrad/s 。要获得另一个转角频率)/(12T βω=，需要知道β的数值， 对于超前校正，最大的超前相角m φ由下式确定 1 1 sin +-= ββφm 因此选)79.64(20 ==m φβ，那么，对应校正装置相角滞后部分的极点的转角频率为 )/(12T βω=就是01.0=ω，于是，超前滞后校正装置的相角滞后部分的传函为 1 1001 520 01.02.0++=++s s s s 相角超前部分：由图1知dB j G 10|)4.2(|=。因此，如果超前滞后校正装置在2=ωrad/s 处提供-10dB 的增益，新的增益穿越频率就是所期望的增益穿越频率。从这一要求出发，可 以画一条斜率为-20dB 且穿过（2rad/s ，-10dB ）的直线。这条直线与0dB 和-26dB 线的交点就确定了转角频率。因此，超前部分的转角频率被确定为s rad s rad /10/5.021==ωω和。 因此，超前校正装置的超前部分传函为 )1 1.01 2(201105.0++=++s s s s 综合校正装置的超前与之后部分的传函，可以得到校正装置的传递函数)(S G c 。 即) 1100)(11.0() 15)(12(01.02.0105.0)(++++=++++= s s s s s s s s s G c 校正后系统的开环传递函数为
H a r b i n I n s t i t u t e o f T e c h n o l o g y 机械原理大作业二 课程名称：机械原理 设计题目：凸轮机构设计 院系：能源学院 班级： 1302402 设计者：黄建青 学号： 1130240222 指导教师：焦映厚陈照波 设计时间： 2015年06月23日
凸轮机构设计说明书 1. 设计题目 设计直动从动件盘形凸轮机构，机构运动简图如图1，机构的原始参数如表1所示。 图1 机构运动简图 表1 凸轮机构原始参数
计算流程框图： 2. 凸轮推杆升程，回程运动方程及推杆位移、速度、加速度线图 2.1 确定凸轮机构推杆升程、回程运动方程 设定角速度为ω=1 rad/s (1) 升程：0°<φ<50° 由公式可得 )]cos(1[20 ?π Φh s -=
)sin( 20 1 ?π ωπΦΦh v = )cos(20 2 2 12?π ωπΦΦh a = (2) 远休止：50°<φ<150° 由公式可得 s = 45 v = 0 a = 0 (3) 回程：150°<φ<240° 由公式得： ()()22 0000200000002200000 0,2(1)(1)1,12(1)(1),2(1)s s s s s s s s s Φhn s h ΦΦΦΦΦΦn Φn ΦΦn h n s h ΦΦΦΦΦΦn Φn n ΦΦΦn hn s ΦΦΦΦΦn Φn ??????'?=---+<≤++?'-? ???''-? =----++ <≤++???'-??? ?'---?'=-++<≤++'-?? 201 00000010002001 000 00n (),(1)(1)n ,(1)(1)n (1),(1)s s s s s s s s Φh v ΦΦΦΦΦΦn Φn ΦΦn h v ΦΦΦΦn Φn n ΦΦΦn h v ΦΦΦΦΦn ΦΦn ω??ω??ω??'=- --+<≤++?'-? ?''-? =- ++<≤++?'-? ?'---'?=--++<≤++''-??
导航原理实验报告 院系： 班级： 学号： 姓名： 成绩： 指导教师签字： 批改日期：年月日 哈尔滨工业大学航天学院 控制科学实验室
实验1 二自由度陀螺仪基本特性验证实验 一、实验目的 1．了解机械陀螺仪的结构特点； 2．对比验证没有通电和通电后的二自由度陀螺仪基本特性表观； 3．深化课堂讲授的有关二自由度陀螺仪基本特性的内容。 二、思考与分析 1． 定轴性 （1） 设陀螺仪的动量矩为H ，作用在陀螺仪上的干扰力矩为M d ，陀螺仪漂移角 速度为ωd ，写出关系式说明动量矩H 越大，陀螺漂移越小，陀螺仪的定轴性(即稳定性)越高. 答案： d d H M ω=? /sin d d H M θω = 干扰力矩M d 一定时，动量矩H 越大，陀螺仪漂移角速度为ωd 越小，陀螺漂移越小， 陀螺仪的定轴性(即稳定性)越高. （2） 在陀螺仪原理及其机电结构方而简要蜕明如何提高H 的量值? 答案：H J =Ω 由公式2A J dm r = ???可知 提高H 的量值有四种途径： 1. 陀螺转子采用密度大的材料,其质量提高了，转动惯量也就提高了。 2. 改变质量分布特性。在质量相同的情况下，若质量分布的半径距质 心越远，H 越大。因此将陀螺转子的有效质量外移，如动力谐陀螺将转子设计成环状。即在陀螺电机定子环中，可做成质量集中分布在环外边缘的环形结构，切边缘部分材质密度大，可提高转动惯量。 3. 增大r,可有效提高转动惯量。 4. 另外可通过采用外转子电机来改变电机质量分布，增大r 。改变电机定转子结构：采用外转子，内定子结构的转子电机。
4. 增加陀螺转子的旋转速度。 2/602(1)/n s f p ωππ==- ，60(1)/n f s p =- 提高电压周波频率 f ↑——〉n ↑——H ↑ f=400Hz 适当减少极对数 ，如取p=1 适当减少转差率s ，可通过减少转子支承轴承摩擦来实现 2．进动性 (1) 在外框架施加一沿x 轴正方向作用力矩时，画出动量矩H 的进动方 向及矢量M ，ω，H 的关系坐标图。(设定H 沿Z 轴正方向)并在坐标中标出陀螺仪自转轴的旋转方向n 。 b) 在内框架施加一沿Y 轴正方向作用力矩时，画出动量矩H 的进动方向及 矢量M ，ω,H 的关系坐标图。(设定H 沿Z 轴正方向)并在坐标中标出陀螺仪自转轴的旋转方向n 。
自动控制原理大作业 1.题目 在通常情况下，自动导航小车（AGV ）是一种用来搬运物品的自动化设备。大多数AGV 都需要有某种形式的导轨，但迄今为止，还没有完全解决导航系统的驾驶稳定性问题。因此，自动导航小车在行驶过程中有时会出现轻微的“蛇行”现象，这表明导航系统还不稳定。 大多数的AGV 在说明书中都声明其最大行驶速度可以达到1m/s ，但实际速度通常只有0.5m/s ,只有在干扰较小的实验室中，才能达到最高速度。随着速度的增加，要保证小车得稳定和平稳运行将变得越来越困难。 AGV 的导航系统框图如图9所示，其中12=40ms =21ms ττ， 。为使系统响应斜坡输入的稳态误差仅为1%，要求系统的稳态速度误差系数为100。试设计合适的滞后校正网络，试系统的相位裕度达到50o ，并估计校正后系统的超调量及峰值时间。 ()R s () Y s 2.分析与校正主要过程
2.1确定开环放大倍数K 100) 1021.0)(104.0(lim )(lim =++==s s s sK s sG K v （s →0） 解得K=100 ) 1021.0)(104.0(100++=s s s G s 2.2分析未校正系统的频域特性 根据Bode 图： 穿越频率s rad c /2.49=ω 相位裕度?---=?-?--=99.18)2.49021.0(arctan )2.4904.0(arctan 9018011γ 未校正系统频率特性曲线
由图可知实际穿越频率为s rad c /5.34=ω 2.3根据相角裕度的要求选择校正后的穿越频率1c ω 现在进行计算： ???--=+=---55550)021.0(arctan )04.0(arctan 901801111c c ωω 则取s rad c /101=ω可满足要求 2.4确定滞后校正网络的校正函数 由于1120 1~101c ωω）（= 因此取s rad c /1101 11== ωω）（，则由Bode 图可以列出
哈工大导航原理大作业-标准化文件发布号：（9456-EUATWK-MWUB-WUNN-INNUL-DDQTY-KII
《导航原理》作业 (惯性导航部分)
一、题目要求 A fighter equipped with SINS is initially at the position of ?35 NL and ?122 EL,stationary on a motionless carrier. Three gyros X G ,Y G ,Z G ,and three accelerometers, X A ,Y A ,Z A are installed along the axes b X ,b Y ,b Z of the body frame respectively. Case 1:stationary onboard test The body frame of the fighter initially coincides with the geographical frame, as shown in the figure, with its pitching axis b X pointing to the east,rolling axis b Y to the north, and azimuth axis b Z upward. Then the body of the fighter is made to rotate step by step relative to the geographical frame. (1) ?10around b X (2) ?30around b Y (3) ?50-around b Z After that, the body of the fighter stops rotating. You are required to compute the final output of the three accelerometers on the fighter, using both DCM and quaternion respectively,and ignoring the device errors. It is known that the magnitude of gravity acceleration is 2/8.9g s m =. Case 2:flight navigation Initially, the fighter is stationary on the motionless carrier with its board 25m above the sea level. Its pitching and rolling axes are both in the local horizon, and its rolling axis is ?45on the north by east, parallel with the runway onboard. Then the fighter accelerate along the runway and take off from the carrier. The output of the gyros and accelerometers are both pulse numbers,Each gyro pulse is an angular increment of sec arc 1.0-,and each accelerometer pulse is g 6e 1-,with 2/8.9g s m =.The gyro output frequency is 10 Hz,and the accelerometer ’s is 1Hz. The output of gyros and accelerometers within 5400s are stored in MATLAB data files named gout.mat and aout.mat, containing matrices gm of 35400? and am of 35400? respectively. The format of data as shown in the tables, with 10 rows of each matrix selected. Each row represents the out of the type of sensors at each sample time.
机械原理大作业 二、题目（平面机构的力分析） 在图示的正弦机构中,已知l AB =100 mm,h1=120 mm,h2 =80 mm,W1 =10 rad/s(常数)，滑块2和构件3的重量分别为G2 =40 N和G3 =100 N,质心S2 和S3 的位置如图所示，加于构件3上的生产阻力Fr=400 N，构件1的重力和惯性力略去不计。试用解析法求机构在Φ1=60°、150°、220°位置时各运动副反力和需加于构件1上的平衡力偶M 。 b Array 二、受力分析图
三、算法 (1)运动分析 AB l l =1 滑块2 22112112/,/s m w l a s m w l v c c == 滑块3 21113113/cos ,sin s m l w v m l s ??== 212 113/sin s m w l a ?-= (2)确定惯性力 N w l g G a m F c 2 1122212)/(== N w l g G a m F 121133313sin )/(?-== (3)受力分析 i F F i F F x R D R x R C R 43434343,=-= j F j F F R R R 232323-==
j F i F j F i F F R x R y R x R R 2121121212--=+= j F F F y R x R R 414141+= 取移动副为首解副 ① 取构件3为分离体，并对C 点取矩 由0=∑y F 得 1323F F F r R -= 由0=∑x F 得 C R D R F F 4343= 由 ∑=0C M 得 2112343/cos h l F F R D R ?= ②取构件2为分离体 由0=∑x F 得 11212cos ?R x R F F = 由0 =∑y F 得 1123212sin ?F F F R y R -= ③取构件1为分离体，并对A 点取矩 由0=∑x F 得 x R x R F F 1241= 由0 =∑ y F 得 y R y R F F 1241= 由0=A M 得 1132cos ?l F M R b = 四、根据算法编写Matlab 程序如下： %--------------已知条件---------------------------------- G2=40; G3=100; g=9.8; fai=0; l1=0.1; w1=10; Fr=400; h2=0.8; %--------分布计算，也可将所有变量放在一个矩阵中求解------------------- for i=1:37 a2=l1*(w1^2); a3=-l1*(w1^2)*sin(fai); F12=(G2/g)*a2;
自动控制原理 大作业 (设计任务书) 姓名: 院系: 班级: 学号:
5、 参考图 5 所示的系统。试设计一个滞后-超前校正装置,使得稳态速度误差常数为20 秒-1,相位裕度为60度,幅值裕度不小于8 分贝。利用MATLAB 画出 已校正系统的单位阶跃与单位斜坡响应曲线。 + 一.人工设计过程 1、计算数据确定校正装置传递函数 为满足设计要求,这里将超前滞后装置的形式选为 ) 1)(()1)(1()(2 12 1T s T s T s T s K s G c c ββ++++ = 于就是,校正后系统的开环传递函数为)()(s G s G c 。这样就有 )5)(1()(lim )()(lim 00++==→→s s s K s sG s G s sG K c c s c s v 205 ==c K 所以 100=c K 这里我们令100=K ,1=c K ,则为校正系统开环传函) 5)(1(100 )(++=s s s s G 首先绘制未校正系统的Bode 图 由图1可知,增益已调整但尚校正的系统的相角裕度为? 23.6504-,这表明系统就是不稳定的。超前滞后校正装置设计的下一步就是选择一个新的增益穿越频率。由)(ωj G 的相角曲线可知,相角穿越频率为2rad/s,将新的增益穿越频率仍选为2rad/s,但要求2=ωrad/s 处的超前相角为? 60。单个超前滞后装置能够轻易提供这一超前角。 一旦选定增益频率为2rad/s,就可以确定超前滞后校正装置中的相角滞后部分的转角频率。将转角频率2/1T =ω选得低于新的增益穿越频率1个十倍频程,即选择2.0=ωrad/s 。要获得另一个转角频率)/(12T βω=,需要知道β的数值,
导航原理(V0.1) 导航贯穿于飞行全过程。正确实施导航，是完成任务的先决条件。对于每一个想要在虚拟战线任务中顺利找到目标，完成任务并安全返航的飞友，熟练的掌握导航技术是必须的。 第一节导航仪表 与导航有关的仪表主要有罗盘和无线电导航仪，罗盘又分为磁罗盘和综合远读罗盘（也叫做转发罗盘），综合远读罗盘实际上是把远读罗盘和无线电导航仪合二为一，比如德机的罗盘中的小飞机就是无线电导航仪的指针，它指向无线电导航台或电台的方位，德机的罗盘外圈的刻度是活动的，跟随航向的变化而旋转，正12点的位置就是当前航向。美国海军飞机的罗盘中的双针就是无线电导航仪的指针，它指向电台方向，单针指示的是当前航向，而美国陆航的指针定义刚好相反，单针是无线电导航仪的指针，双针指示当前航向。苏机的无线电导航仪是单独的，它的使用我们以后再说。磁罗盘实际上跟指南针是一样的，只是它的刻度盘是做在磁体上的，跟磁体一起旋转，因此它只能在水平状态下使用。导航仪表中还包括航空时钟，它跟我们平时用的钟一样，这里就不讲了。 综合远读罗盘（德）综合远读罗盘（美）磁罗盘（美） 磁罗盘（苏）无线电导航仪（苏）
第二节判读航图和导航计算 航图的判读是导航的基础，游戏中的航图，跟我们常见的地图大体相同，所用的图标也很相似，但由于游戏本身的特点，以及我们在飞行中的实际需要，因此也有一些不同的地方。 图1 图例图2放大后的图1局部游戏中的航图图标大多与真实地图相同，如浅蓝色不规则线条表示河流，较大面积浅蓝色区域表示湖泊，黑色线条表示铁路，但公路却分为两种，红线表示泥土公路，黄色带棕色边的线表示沥青或水泥公路，大块的绿色区域表示森林，森林间的浅色区域表示草地，不规则的小块黄色区域表示城镇，城镇上面标有城镇名称。图中的蓝色菱形图标表示空军基地。 游戏中的航图跟真实地图一样是上北下南，左西右东，并且也采用 经度和纬度，图2是放大后的地图，可以看到地图边缘标有经度和纬度， 但游戏中的航图主要采用英文字母和数字来表示位置。图1是我们看航 图时最常用的一种比例，图中经线和纬线交叉将地图划分为一个个区 域，用英文字母代表纵列（经度），用数字代表横列（纬度），两条经线 和两条纬线之间的距离是10千米，因此地图上每一个区域的边长是10 千米。每一个区域可以用字母和数字来表示，如D5、E3等等。图3 区域分划但用这样的方法来表示位置不够精确，因此我们在此基础上将每一个区域分为9个小区，每个小区用一个数字来表示，以增加精度。如图3，将一个区域（图中为D3）均分为9个小区，用小键盘上的数字键位置进行编号，这样每一个小区就可以这样表示，如D3-1，D3-6。图1中的空军基地，如果用D3来表示，因为D3地区有10×10千米，因此精度很低，而如果用D3-5来表示，由于D3-5小区只有3.3×3.3千米，精度大为提高。 一般的航图显示比例分为两个档次，既每格10千米和每格1千米，而在太平洋地区的一些地
Harbin Institute of Technology 机械原理大作业（一） 课程名称：机械原理 设计题目：连杆机构运动分析 院系：机电工程学院 班级： 设计者： 学号： 指导教师：
一、题目（13） 如图所示机构，已知各构件尺寸：Lab=150mm;Lbc=220mm;Lcd=250mm;Lad=300mm;Lef=60mm;Lbe=110mm;EF⊥BC。试研究各杆件长度变化对F点轨迹的影响。 二、机构运动分析数学模型 1.杆组拆分与坐标系选取 本机构通过杆组法拆分为： I级机构、II级杆组RRR两部分如下：
2.平面构件运动分析的数学模型 图3 平面运动构件（单杆）的运动分析 2.1数学模型 已知构件K 上的1N 点的位置1x P ,1y P ，速度为1x v ,1Y v ，加速度为1 x a ，1y a 及过点的1N 点的线段12N N 的位置角θ，构件的角速度ω，角加速度ε，求构件上点2N 和任意指定点3N （位置参数13N N ＝2R ，213N N N ∠＝γ）的位置、 速度、加速度。 1N ，3N 点的位置为： 211cos x x P P R θ=+ 211sin y y P P R θ=+ 312cos()x x P P R θγ=++ 312sin()y y P P R θγ=++ 1N ，3N 点的速度，加速度为： 211211sin ()x x x y y v v R v P P ωθω=-=-- 211121sin (-) y y y x x v v R v P P ωθω=-=- 312131sin() () x x x y y v v R v P P ωθγω=-+=--312131cos()() y y y x x v v R v P P ωθγω=-+=-- 2 212121()()x x y y x x a a P P P P εω=---- 2 212121()() y y x x y y a a P P P P εω=+--- 2313131()()x x y y x x a a P P P P εω=---- 23133(1)(1) y y x x y y a a P P P P εω=+--- 2.2 运动分析子程序 根据上述表达式，编写用于计算构件上任意一点位置坐标、速度、加速度的子程序如下： 1>位置计算 function [s_Nx,s_Ny ] =s_crank(Ax,Ay,theta,phi,s) s_Nx=Ax+s*cos(theta+phi); s_Ny=Ay+s*sin(theta+phi); end 2>速度计算 function [ v_Nx,v_Ny ] =v_crank(s,v_Ax,v_Ay,omiga,theta,phi) v_Nx=v_Ax-s*omiga.*sin(theta+phi); v_Ny=v_Ay+s*omiga.*cos(theta+phi); end 3>加速度计算 function [ a_Nx,a_Ny ]=a_crank(s,a_Ax,a_Ay,alph,omiga,theta,phi) a_Nx=a_Ax-alph.*s.*sin(theta+phi)-omiga.^2.*s.*cos(theta+phi);
吉林大学网络教育学院2019-2020学年第一学期期末考试《自动控制原理》大作业 学生姓名专业 层次年级学号 学习中心成绩 年月日
作业完成要求：大作业要求学生手写，提供手写文档的清晰扫描图片，并将图片添加到word 文档内，最终wod文档上传平台，不允许学生提交其他格式文件（如JPG，RAR等非word 文档格式），如有雷同、抄袭成绩按不及格处理。 综合题（每小题10分，共100分） 1、试用部分分式法、幂级数法和反演积分法，求下列函数的z反变换： (1) )2 )(1 ( 10 ) ( - - = z z z z E (2) 2 1 1 2 1 3 ) ( - - - + - + - = z z z z E 2、试确定下列函数的终值： (1) 2 1 1 ) 1( ) ( - - - = z Tz z E (2) )1.0 )( 8.0 ( ) ( 2 - - = z z z z E 3、设开环离散系统如图所示，试求开环脉冲传递函数G(Z)。 第3题图 4、当 z z z z z z C 5.0 5.1 1 2 ) ( 2 3 2 3 + - + + =时，计算系统前4个采样时刻c(0)，c(T)，c(2T)和c(3T)的响应。 5、已知线性离散系统的闭环脉冲传递函数为 2.0 1.0 ) ( 2 2 - + + = Φ z z z z z，试判断该系统 是否稳定。 6、设有零阶保持器的离散系统如下图所示，试求： （1）当采样周期T为1s和0.5s时，系统的临界开环增益K c； （2）当r(t)=1(t)，K=1，T分别为2s，4s时，系统的输出响应c(kT)。
《惯性导航原理》课程习题 2012年 5月30日，授课老师：吴了泥 1．分类介绍当代导航系统？ 2．平台式惯导的硬件组成，各个器件的作用？ 3．自由转子陀螺的干扰力矩由哪些引起，高精度陀螺如何改进支撑方式，减小干扰力矩。 4．描述转子陀螺的定轴性、进动性、表观运动和章动。 5．用动量距定理说明转子陀螺进动方向和大小，说明转子陀螺的表观运动。 6．描述双自由度陀螺的技术方程。从技术方程出发，描述常值外力矩下陀螺的运动。 7．描述单自由度陀螺的技术方程，并解算单自由度陀螺的种类。 8．说明双自由度陀螺、单自由度陀螺如何测量角运动。 9．说明二自由度陀螺的单轴稳定平台如何实现稳定和跟踪。 10．简要描述动力调谐陀螺、激光陀螺、光纤陀螺和微机械陀螺的的机理和特点。 11．普通摆式加速度计的技术方程，说明测量机理。 12．挠性摆式加速度计的结构，简要描述其工作机理，并给出技术方程。 13．描述惯性坐标系，导航坐标系，地理坐标系，以及机体坐标系的定义。 14．说明比力的概念，写出比力方程，并描述比力方程的意义？ 15．描述休拉调谐，及其物理意义？陀螺稳定平台如何实现休拉调谐？ 16．说明惯导垂直通道为什么是不稳定的？说明垂直通道阻尼回路的作用。 17．平台式惯导的力学编排，及施矩指令。 18．平台式惯导有哪些误差源，并描述误差传播过程。 19．简要推导姿态误差方程、速度误差方程和位置误差方程。 20．惯导的基本误差特性是哪三种振荡运动合成的？说明三种振荡运动产生的原因。 21．简要说明平台式惯导水平对准和方位对准的基本原理。 22．捷联惯导和平台惯导的区别，捷联惯导的优缺点？ 23．说明比力坐标变换的方法。 24．描述欧拉角的定义，用欧拉角法描述姿态矩阵，并写出微分方程。 25．描述四元数法的物理意义，用四元数法描述姿态矩阵，并写出微分方程。写出四元数和欧拉角间的转换关系。 26．什么叫转动的不可交换性误差？旋转等效矢量法是如何消除转动不可交换性误差？用旋转等效矢量法描述姿态矩阵，并写出微分方程。
机械原理大作业三 课程名称: 机械原理 级: 者: 号: 指导教师: 设计时间: 1.2机械传动系统原始参数 设计题目： 系: 齿轮传动设计 1、设计题 目 1.1机构运动简图 - 11 7/7777777^77 3 UtH TH7T 8 'T "r 9 7TTTT 10 12 - 77777" 13 ///// u 2
电动机转速n 745r/min ,输出转速n01 12r/mi n , n02 17r /mi n , n°323r/min，带传动的最大传动比i pmax 2.5 ,滑移齿轮传动的最大传动比 i vmax 4，定轴齿轮传动的最大传动比i d max 4。 根据传动系统的原始参数可知，传动系统的总传动比为： 传动系统的总传动比由带传动、滑移齿轮传动和定轴齿轮传动三部分实 现。设带传动的传动比为i pmax 2.5，滑移齿轮的传动比为9、心、「3，定轴齿轮传动的传动比为i f，则总传动比 i vi i vmax 则可得定轴齿轮传动部分的传动比为 滑移齿轮传动的传动比为 设定轴齿轮传动由3对齿轮传动组成，则每对齿轮的传动比为 3、齿轮齿数的确定 根据滑移齿轮变速传动系统中对齿轮齿数的要求，可大致选择齿轮5、6、 7、8 9和10为角度变位齿轮，其齿数: Z5 11,Z6 43,Z7 14,Z8 39,Z9 18,乙。35 ；它们的齿顶高系数0 1，径向间隙
系数c 0.25，分度圆压力角200，实际中心距a' 51mm。 根据定轴齿轮变速传动系统中对齿轮齿数的要求，可大致选择齿轮11、12、13和14为角度变位齿轮，其齿数：Z11 z13 13，乙 2 z14 24。它们的齿顶高系数d 1，径向间隙系数c 0.25，分度圆压力角200,实际中心距 a' 46mm。圆锥齿轮15和16选择为标准齿轮令13,乙 6 24，齿顶高系数 h a 1，径向间隙系数c 0.20，分度圆压力角为200（等于啮合角’）。 4、滑移齿轮变速传动中每对齿轮几何尺寸及重合度的计算 4.1滑移齿轮5和齿轮6
哈工大自动控制原理大 作业 HUA system office room 【HUA16H-TTMS2A-HUAS8Q8-HUAH1688】
Harbin Institute of Technology 课程设计说明书（论文） 课程名称：自控控制原理大作业 设计题目：控制系统的矫正 院系：自动化测试与控制系 班级： 设计者： 学号： 指导教师：强盛 设计时间： 2016.12.21 哈尔滨工业大学 题目8 8. 在德国柏林，磁悬浮列车已经开始试验运行，长度为 1600m的M-Bahn号实验线路系统代表了目前磁悬浮列车的发展水平。自动化的磁悬浮列车可以在较短的时间内正常运行，而且具有较高的能量利用率。车体悬浮控制系统的框图模型如图 8 所示，试设计一
个合适的校正网络，使系统的相位裕度满足45°≤ γ ≤55°，并估算校正后系统的阶跃响应。 图 8 题 8 中磁悬浮列车悬浮控制系统 一、人工设计 利用半对数坐标纸手工绘制系统校正前后及校正装置的Bode图，并确定出 校正装置的传递函数。验算校正后系统是否满足性能指标要求。 1)未校正系统的开环频率特性函数应为： γ0(γγ)= 1 γ2(γ+10) 2)未校正系统的幅频特性曲线图如下： 由图中可以得出: γγ=√γ=0.316 rad/s 对应的相位裕度为: γ(γγ)=180°?180°?arctan( γγ 10 )=?1.81° G c(s) 1
3)超前校正提供(m)=50° 4)γ?1 γ+1 =γγγ50°解得 a=7.5 5)?10γγγ=?8.75γγ,得到γγ=0.523 rad/s 6)1 γ=√γγγ=1.43 rad/s 1 γγ =0.19 rad/s 7)γγ(γ)=1+5.3γ 1+0.7γ 二、计算机辅助设计 利用MATLAB语言对系统进行辅助设计、仿真和调试 g = tf(1,[1 10 0 0]); gc = tf([5.3 1],[0.7 1]); ge = tf([5.3 1],conv([0.7 1],[1 10 0 0])); bode(g,gc,ge); grid legend('uncompensated','compensator','compensated') [kg,r,wg,wc]=margin(ge)