Добавил:
Upload Опубликованный материал нарушает ваши авторские права? Сообщите нам.
Вуз: Предмет: Файл:
Лаб_практикум_ОТЧЕ.doc
Скачиваний:
1
Добавлен:
01.04.2025
Размер:
6 Мб
Скачать
☆

2.1.3.3. Вплив тертя на рух сзг

Розглянемо спочатку вплив тертя на вільний рух СЗГ. Вважатимемо, задля спрощення, що тертя є "в'язким", момент сил якого є пропорційним до відповідної кутової швидкості тіла. Тому у подальшому припускатимемо:

; . (2.25)

Це припущення дозволяє наближено подати рівняння (2.1) у вигляді:

, (2.26)

де

; . (2.27)

Розв'язок рівнянь (2.26) можна подати у вигляді

, (2.28)

де використані позначення

; . (2.29)

Повернемося до рис. 2.3. Через те, що осі і лежать у екваторіальній площині, матимемо

;

;

.

Звідси випливає, що кути і можна подати також й через екваторіальні складові кутової швидкості гіроскопа:

;

.

Через те, що екваторіальні складові кутової швидкості, у відповідності до розв'язків (2.28), з часом прагнуть до нуля, кути і , як випливає з встановлених співвідношень, теж прагнутимуть до нуля. Це означає, що під впливом тертя вісь фігури з часом необмежено наближається до кінетичної осі. При цьому вісь фігури здійснює навколо кінетичної осі нутаційні коливання з поступово зменшуваною амплітудою.

Якщо аналогічні міркування застосувати до руху СЗГ дід дією сталого момента сил, можна дійти аналогічного висновку: нутаційні коливання СЗГ загасатимуть, при цьому вісь фігури вже прагнутиме не кінетичної осі, а тієї осі, яка була центром нутаційних коливань. Після повного загасання нутаційних коливань вісь фігури, як і кінетична вісь, здійснюватимуть рівномірне обертання навколо нерухомої осі з кутовою швидкістю (2.19), тобто вимушену регулярну прецесію.

2.1.4. Опис програмних засобів

Дослідження здійснюється шляхом чисельного інтегрування диференційних рівнянь СЗГ у середовищі MatLAB. Для цього розроблений пакет програм і процедур мовою системи MatLAB, що складається з наступних програмних одиниць:

  1. керуючого script-файла SUG_m.m - головної програми, яка почергово викликає програми SUG_ZastavkaM.m, SUG_MenuM.m, SUG_YadroM.m та SUG_VyvodM.m і забезпечує повернення до початку програми для повторювання дій;

  2. script-файла SUG_ZastavkMa.m, який здійснює введення первісних даних і виведення текстової інформації про програму до екрану дисплею;

  3. script-файла SUG_MenuM.m, який забезпечує змінювання даних у діалоговому режимі;

  4. script-файла SUG_YadroM.m, який викликає на запуск програму SUG.mdl, яка забезпечує моделювання поведінки СЗГ за повними рівняннями.

  5. script-файла SUG_VyvodM.m, який здійснює вивід в графічній формі на екран результатів моделювання.

Тексти головних з зазначених файлів наведено нижче.

% SUG_M.m

% Головна (керуюча) програма моделювання поводження

% СИМЕТРИЧНОГО УРІВНОВАЖЕНОГО ГІРОСКОПА

% Ю.Ф.Лазарев, кафедра ПСОН, КПІ, Україна,

% Почато 28-02-2008 Останні змінювання 28-06-2008

clear all, clc

SUG_ZastavkaM

k = menu(' Що робити ? ',' Продовжити роботу ', ' Закінчити роботу ');

if k==1, sname =input('Введіть ваше призвище та ініціали (в апостофах) ');

if isempty(sname), sname='Ю.Ф.ЛАЗАРЄВ'; end

while k==1

SUG_MenuM

SUG_YadroM

SUG_VyvodM

k = menu(' Що робити ? ',' Продовжити роботу ', ' Закінчити роботу ');

end

end

==================================

% SUG_ZastavkaM

% Частина програми SUG_M, яка здійснює введення первісних значень даних

% Ю.Ф.Лазарев, кафедра ПСОН, КПІ, Україна,

% Почато 28-02-2008 Останні зміни 6-03-2008

% Задание значений исходных данных

% 1. Параметры моментов сил по осям Peзаля

% 1.1. Параметры явной зависимости от времени

% 1.1.1. Постоянные составляющие моментов

Mx0=0; My0=0; Mz0=0;

% 1.1.2. Амплитуды моментов

Mxm=0; Mym=0; Mzm=0;

% 1.1.3. Частоты изменения моментов

omx=0.; omy=omx; omz=omx;

% 1.1.4. Начальные фазы моментов

ex=0; ey=0; ez=0;

% 1.2. Коэффициенты вязкого трения

fx=1.; fy=1; fz=0;

% 2. Начальные условия

% 2.1. Начальное значение кинетического момента гироскопа

H0=20;

% 2.2. Начальное угловое положение главной оси гироскопа

al0=0*pi/180; bt0=45*pi/180;

% 2.3. Начальные угловые скорости главной оси

alt0=0; btt0=4;

% 3. Моменти інерції СЗГ

Je=5; J=7;

% 4. Параметри інтегрування

% 4.1. Кількість кроків інтегрування у найменшому періоді

% коливань

ni=100;

% 4.2. Інтервал інтегрування у часі у кількості

% найбільших періодів коливань

ntk=20;

% ===== Розрахунки кроку та кінцевої миті інтегрування

lambda=abs(H0)/Je; % Частота нутації СЗГ

mx=max(abs([lambda,omx,omy,omz])); % Максимальна частота коливань

hi=2*pi/(ni*mx); % Крок інтегрування

if lambda~=0, Tmax=2*pi/lambda;

if omx~=0, T1=2*pi/abs(omx); Tmax=max([Tmax T1]); end

if omy~=0, T1=2*pi/abs(omy); Tmax=max([Tmax T1]); end

if omz~=0, T1=2*pi/abs(omz); Tmax=max([Tmax T1]); end

else,

disp('Помилка! Кінетичний момент гіроскопа не може дорівнювати нулеві !'); end

tfinal=ntk*Tmax; % Кінцева мить інтегрування

%%%% Формування текстового оформлення екрану %%%%%

clc,echo on

%

% Перед Вами програма SUG_M.m

% "Моделювання поводження

% СИМЕТРИЧНОГО УРІВНОВАЖЕНОГО ГІРОСКОПА"

% яка складає програмну основу

% лабораторної роботи N% 2 з дисципліни

% "Основи теорії ЧУТЛИВИХ ЕЛЕМЕНТІВ"

%

echo off

================================================

% SUG_MenuM

% Частина програми SUG_M, яка здійснює

% діалогове ЗМІНЮВАННЯ ВСТАНОВЛЕНИХ ПАРАМЕТРІВ

% Ю.Ф.Лазарев, кафедра ПСОН, КПІ, Україна,

% Почато 28-02-2008 Останні зміни 29-06-2008

k=1;

while k<10

clc, disp(' '); disp(' '); disp([' З програмою SUG_M.m працює ',sname]); echo on

% Моделюється рух

% Симетричного Урівноваженого Гіроскопа

% шляхом чисельного інтегрування його ДР

%

% Je*al"*cos(bt) + [H-2*Je*al'*sin(bt)]*bt' = Mx

% Je*bt" - [H-Je*al'*sin(bt)]*al'*cos(bt) = My

% dH/dt = Mz

%

echo off

k=menu(' Що змінювати? ',...

sprintf('Кінетичний момент CУГ = %g',H0),...

[sprintf('Моменти інерції СЗГ: Je= %g;',Je),sprintf(' J= %g;',J)],...

[sprintf('Початкові умови: al0= %g;',al0*180/pi),sprintf(' bt0= %g;',bt0*180/pi),sprintf(' alt0= %g;',alt0),sprintf(' btt0= %g;',btt0)],...

[sprintf('Поcтійні складові моментів сил: Mx0= %g;',Mx0),sprintf(' My0= %g;',My0),sprintf(' Mz0= %g;',Mz0)],...

[sprintf('Амплітуди моментів сил: Mxm= %g;',Mxm),sprintf(' Mym= %g;',Mym),sprintf(' Mzm= %g;',Mzm)],...

[sprintf('Частоти змінювання моментів сил: omx= %g;',omx),sprintf(' omy= %g;',omy),sprintf(' omz= %g;',omz)],...

[sprintf('Фази змінювання моментів сил: ex= %g;',ex*180/pi),sprintf(' ey= %g;',ey*180/pi),sprintf(' ez= %g;',ez*180/pi)],...

[sprintf('Коеф-ти в''язкого тертя по осях підвісу: fx= %g;',fx),sprintf(' fy= %g;',fz),sprintf(' fy= %g;',fz)],...

[sprintf('Параметри інтегрування: ni= %g;',ni),sprintf(' ntk= %g;',ntk)], ' Нічого не змінювати ');

disp(''),

if k==1, H0=input(sprintf('Зараз H0=%g; Введіть нове значення =',H0)); end

if k==2, k2=1;

while k2<3

k2=menu(' Що саме змінити? ', sprintf(' Je= %g;',Je), sprintf(' J= %g;',J),…

' Нічого не змінювати ');

if k2==1, Je=input(sprintf('Зараз Je=%g; Введіть нове значення =',Je)); end

if k2==2, J=input(sprintf('Зараз J=%g; Введіть нове значення =',J)); end

end

end

if k==3, k2=1;

while k2<5

k2=menu(' Що саме змінити? ', sprintf(' al0= %g;',al0*180/pi),…

sprintf(' bt0= %g;',bt0*180/pi),...

sprintf(' alt0= %g;',alt0), sprintf(' btt0= %g;',btt0), ' Нічого не змінювати ');

if k2==1, al0=input(sprintf('Зараз al0=%g; …

Введіть нове значення (у градусах) =',al0*180/pi)); al0=al0*pi/180; end

if k2==2, bt0=input(sprintf('Зараз bt0=%g;…

Введіть нове значення (у градусах) =',bt0*180/pi)); bt0=bt0*pi/180; end

if k2==3, alt0=input(sprintf('Зараз alt0=%g; Введіть нове значення =',alt0)); end

if k2==4, btt0=input(sprintf('Зараз btt0=%g; Введіть нове значення =',btt0)); end

end

end

if k==4, k2=1;

while k2<4

k2=menu(' Що саме змінити? ', sprintf(' Mx0= %g;',Mx0),

sprintf(' My0= %g;',My0),...

sprintf(' Mz0= %g;',Mz0), ' Нічого не змінювати ');

if k2==1, Mx0=input(sprintf('Зараз Mx0=%g; Введіть нове значення

=',Mx0)); end

if k2==2, My0=input(sprintf('Зараз My0=%g; Введіть нове значення

=',My0)); end

if k2==3, Mz0=input(sprintf('Зараз Mz0=%g; Введіть нове зна

чення ,Mz0)); end

end

end

if k==5, k2=1;

while k2<4

k2=menu(' Що саме змінити? ', sprintf(' Mxm= %g;',Mxm), …

sprintf(' Mym= %g;',Mym),sprintf(' Mzm= %g;',Mzm), ' Нічого не змінювати ');

if k2==1, Mxm=input(sprintf('Зараз Mxm=%g; Введіть нове значення

=',Mxm)); end

if k2==2, Mym=input(sprintf('Зараз Mym=%g; Введіть нове значення

=',Mym)); end

if k2==3, Mzm=input(sprintf('Зараз Mzm=%g; Введіть нове значення =',Mzm)); end

end

end

if k==6, k2=1;

while k2<4

k2=menu(' Що саме змінити? ', sprintf(' omx= %g;',omx), …

sprintf(' omy= %g;',omy),sprintf(' omz= %g;',omz),' Нічого не змінювати ');

if k2==1, omx=input(sprintf('Зараз omx=%g; Введіть нове значення =',omx)); end

if k2==2, omy=input(sprintf('Зараз omy=%g; Введіть нове значен

ня=',omy)); end

if k2==3, omz=input(sprintf('Зараз omz=%g; Введіть нове значення

=',omz)); end

end

end

if k==7, k2=1;

while k2<4

k2=menu(' Що саме змінити? ', …

sprintf(' ex= %g;',ex*180/pi), sprintf(' ey= %g;',ey*180/pi),

sprintf(' ez= %g;',ez*180/pi), ' Нічого не змінювати ');

if k2==1, ex=input(sprintf('Зараз ex=%g; …

Введіть нове значення (у градусах) =',ex*180/pi)); ex=ex*pi/180; end

if k2==2, ey=input(sprintf('Зараз ey=%g; …

Введіть нове значення (у градусах) =',ey*180/pi)); ey=ey*pi/180; end

if k2==3, ez=input(sprintf('Зараз ez=%g;…

Введіть нове значення (у градусах) =',ez*180/pi)); ez=ez*pi/180; end

end

end

if k==8, k2=1;

while k2<4

k2=menu(' Що саме змінити? ', sprintf(' fx= %g;',fx), sprintf(' fy= %g;',fy),...

sprintf(' fz= %g;',fz), ' Нічого не змінювати ');

if k2==1, fx=input(sprintf('Зараз fx=%g; Введіть нове значення =',fx));

end

if k2==2, fy=input(sprintf('Зараз fy=%g; Введіть нове значення =',fy));

end

if k2==3, fz=input(sprintf('Зараз fz=%g; Введіть нове значення =',fz));

end

end

end

if k==9, k2=1;

while k2<3

k2=menu(' Що саме змінити? ',…

sprintf('Кількість кроків на мінімальному періоді ni= %g;',ni),...

sprintf('Кількість максимальних періодів ntk= %g;',ntk), ' Нічого не

змінювати ');

if k2==1, ni=input(sprintf('Зараз ni=%g; Введіть нове значення =',ni));

end

if k2==2, ntk=input(sprintf('Зараз ntk=%g; Введіть нове значення =',ntk));

end

end

end

end

% ===== Розрахунки кроку та кінцевої миті інтегрування

lambda=abs(H0)/Je; % Частота нутації ГКП

mx=max(abs([lambda,omx,omy,omz])); % Максимальна частота коливань

hi=2*pi/(ni*mx); % Крок інтегрування

if lambda~=0, Tmax=2*pi/lambda;

if omx~=0, T1=2*pi/abs(omx); Tmax=max([Tmax T1]); end

if omy~=0, T1=2*pi/abs(omy); Tmax=max([Tmax T1]); end

if omz~=0, T1=2*pi/abs(omz); Tmax=max([Tmax T1]); end

else

disp('Помилка! Кінетичний момент гіроскопа не може дорівнювати нулеві !');

end

tfinal=ntk*Tmax % Кінцева мить інтегрування

=================================================

% SUG_YadroM

% Частина програми SUG_M, яка здійснює власне моделювання поводження

% Гіроскопа у кардановому підвісі

% Ю.Ф.Лазарев, кафедра ПСОН, КПІ, Україна,

% Почато 28-02-2008 Останні зміни 29-06-2008

A0=al0; B0=bt0; OeX0=alt0*cos(bt0); OeY0=btt0;

[T,X,al,bt,H,omX,omY]=sim('sugM');%%%%----- Запуск SIMULINK-моделi ----- %%%%%

KY=Je*omY; KX=Je*omX; KK=sqrt(H.^2+KX.^2+KY.^2); Kksi=H.*sin(bt)+KX.*cos(bt);

Ka=H.*cos(bt)-KX.*sin(bt); Keta=KY.*cos(al)-Ka.*sin(al); Kdz=KY.*sin(al)+Ka.*cos(al);

alk=-atan(Keta./Kdz); btk=asin(Kksi./KK);

Ця програма викликає на виконання SIMULINK-модель, яка записана у файлі SUGm. mdl. S-модель SUGm у власну чергу організує обчислення згідно схеми, наведеної на рис. 2.4.

Рис. 2.4. Блок-схема S-моделі SUGm

Рис. 2.5. Блок-схема блоку МОМЕНТИ

Рис. 2.6. Блок-схема блоку Мх(t)

В її склад входять S-блок МОМЕНТИ, схема якого надана на рис. 1.5, а у склад того входять три блоки Mx(t), My(t) i Mz(t), які реалізують імітування дії відповідних моментів сил за однаковою схемою, відображеною на рис 1.6.

Головним же блоком, який, власне, й реалізує чисельне інтегрування диференційних рівнянь гіроскопа є блок СЗГ, в якому реалізується виконання S-функції ur_SUG, текст якої наведений нижче.

=================================================================

function [sys,x0,str,ts] = ur_SUG(t,x,u,flag,H0,Je,A0,B0,OeX0,OeY0)

% S-функція, яка здійснює чисельне інтегрування ДР СЗГ (для SUG_m)

% Лазарєв Ю. Ф. 28-02-2008

switch flag,

case 0, [sys,x0,str,ts]=mdlInitializeSizes(H0, A0, B0, OeX0, OeY0);

case 1, sys=mdlDerivatives(t,x,u,Je);

case 2, %sys=mdlUpdate(t,x,u);

case 3, sys=mdlOutputs(t,x,u);

case 4, sys=mdlGetTimeOfNextVarHit(t,x,u);

case 9, %sys=mdlTerminate(t,x,u);

otherwise

error(['Unhandled flag = ',num2str(flag)]);

end

%======================================================

function [sys,x0,str,ts]=mdlInitializeSizes(H0, A0, B0, OeX0, OeY0)

sizes = simsizes;

sizes.NumContStates = 5; sizes.NumDiscStates = 0; sizes.NumOutputs = 5;

sizes.NumInputs = 3; sizes.DirFeedthrough = 1; sizes.NumSampleTimes = 1;

sys = simsizes(sizes); x0 = [ A0, B0, H0, OeX0, OeY0]; str = []; ts = [0 0];

%====================================================

function z=mdlDerivatives(t,x,u,Je)

% x(1)=alfa x(2)=beta x(3)=H x(4)=omX x(5)=omY u(1)=My u(2)=Mz u(3)=Mx

z(1) = x(4)/cos(x(2)); z(2) = x(5); z(3) = u(2);

dH=x(3)/Je-x(4)*tan(x(2)); z(4) =- x(5)*dH+u(3)/Je; z(5) = x(4)*dH+u(1)/Je;

%==================================================

function y=mdlOutputs(t,x,u)

y = x;

Далі поданий текст програми SUG_VyvodM виведення результатів моделювання у графічній формі у окреме графічне вікно.

========================================================

% SUG_VyvodM

% Частина програми SUG_M, яка здійснює

% ВИВЕДЕННЯ РЕЗУЛЬТАТІВ моделювання НА ЕКРАН

% Ю.Ф.Лазарев, кафедра ПСОН, КПІ, Україна,

% Початок 28-02-2008 Останні зміни 29-06-2008

subplot(2,2,1)

plot(al*180/pi,bt*180/pi,alk*180/pi,btk*180/pi,'+r'), grid, set(gca,'Fontname','MS Sans Serif')

title('Картинна площина','Fontsize',12,'FontWeight','bold');

xlabel('\alpha, градуси '); ylabel('\beta '); legend(' АПЕКС','кінетична вісь',0)

subplot(2,2,3)

polar(0,1), grid, set(gca,'Fontname','MS Sans Serif'),hold on

polar(al,cos(bt)),polar(alk,cos(btk),'r+')

title('Погляд згори на сферу','Fontsize',12,'FontWeight','bold'); hold off

subplot(2,2,4)

plot(T,al,T,bt,'.',T,omX,'--',T,omY,'.-'), grid, set(gca,'Fontname','MS Sans Serif')

title('Кути та кутові швидкості','Fontsize',12,'FontWeight','bold');

xlabel('Час, с '); legend('\alpha (рад)','\beta (рад)','\omega_X (рад/с)','\omega_Y (рад/c)',0)

subplot(2,2,2),axis off

h=text(-0.2,1.17,'Симетричний Урівноважений Гіроскоп',...

'Fontsize',14,'FontWeight','bold','Fontname','MS Sans Serif');

h=text(0.1,1.05,'Параметри СЗГ:','Fontsize',12,'Fontname','MS Sans Serif');

h=text(-0.2,0.95,sprintf('H_0=%g;',H0)); h=text(0.25,0.95,sprintf('J_e=%g;',Je));

h=text(0.7,0.95,sprintf('J=%g;',J));

h=text(0.1,0.85,'Початкові умови:','Fontsize',12,'Fontname','MS Sans Serif');

h=text(0.,0.75,sprintf('\\alpha_0=%g;',al0*180/pi));

h=text(0.5,0.75,sprintf('\\beta_0=%g;',bt0*180/pi));

h=text(0.,0.65,sprintf('\\alpha\\prime_0=%g;',alt0));

h=text(0.5,0.65,sprintf('\\beta\\prime_0=%g;',btt0));

h=text(0.1,0.55,'Параметри моментів сил:','Fontsize',12,'Fontname','MS Sans Serif');

h=text(-0.2,0.45,sprintf('M_x_0=%g;',Mx0)); h=text(-0.2,0.35,sprintf('M_y_0=%g;',My0));

h=text(-0.2,0.25,sprintf('M_z_0=%g;',Mz0)); h=text(0.1,0.45,sprintf('M_x_m=%g;',Mxm));

h=text(0.1,0.35,sprintf('M_y_m=%g;',Mym)); h=text(0.1,0.25,sprintf('M_z_m=%g;',Mzm));

h=text(0.4,0.45,sprintf('\\omega_x=%g;',omx)); h=text(0.4,0.35,sprintf('\\omega_y=%g;',omy));

h=text(0.4,0.25,sprintf('\\omega_z=%g;',omz)); h=text(0.7,0.45,sprintf('\\epsilon_x=%g;',ex*180/pi));

h=text(0.7,0.35,sprintf('\\epsilon_y=%g;',ey*180/pi));

h=text(0.7,0.25,sprintf('\\epsilon_z=%g;',ez*180/pi));

h=text(-0.2,0.15,[sprintf('Коефіцієнти в''язкого тертя: f_x=%g;',fx),...

sprintf(' f_y=%g;',fy),sprintf(' f_z=%g;',fz)],'Fontname','MS Sans Serif');

h=text(-0.2,0.05,[sprintf('Крок: hi=%g c;',hi),...

sprintf(' Час tfinal=%g c;',tfinal)],'Fontname','MS Sans Serif');

h=text(-0.3,0,'==================================================');

h1=text(-0.3,-0.05,'Програма SUG-M.m;','Fontname','MS Sans Serif');

h1=text(0.35,-0.05,'Автор - ЛAЗАРЄВ Ю.Ф.','Fontname','MS Sans Serif');

h1=text(-0.3,-0.15,['Виконав ',sname],'Fontname','MS Sans Serif'); tm=fix(clock); Tv=tm(4:5);

h1=text(0.5,-0.15,[sprintf(' %g:',Tv),' ',date]);

h=text(-0.3,-0.2,'==================================================');

Соседние файлы в предмете [НЕСОРТИРОВАННОЕ]