Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях

Как показано в [1], задача синтеза робастного управления в виде обратной связи по состоянию для системы (5.2) с неопределенными возмущениями из (5.3) и параметрическими изменениями, представленными в виде (5.6) с матрицей D, удовлетворяющей ограничению (5.7), сводится к одной из следующих задач оптимизации с ЛМН:

Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru или Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru

при ограничениях

Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru (5.8)

Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru , (5.9)

где минимизация проводится по матричным переменным Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru , скалярным параметрам q>0, α>0. определяет при фиксированных q и α определяет матрицу Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru предельного инвариантного эллипсоида для вектора состояния x(t), матрицу Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru предельного ограничивающего эллипсоида для вектора выхода z(t) системы (5.4) и матрицу коэффициентов соответствующего регулятора по состоянию Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru .

Для решении задач Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru при ограничении (5.8) и Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru при ограничениях (5.8),(5.9) была разработана программа, текст которой представлен ниже.

step = 0.25;

begin_val = 2.0;%1.9969;%1.7250;%

end_val = 2.5;%1.9969;%0.2;%-min(eig(A-B*K));

min_tr_Z = 1000000;

%figure (3)

% Синтез робастного регулятора по состоянию при учете неопределенных ограниченных возмущений и параметрических изменений

% Оптимизация по параметрам q и alf путем перебора с уменьшающимся шагом

while step>0.001

for q = begin_val:step:end_val

for alf = 0.11:0.01:0.11

cvx_begin sdp

variable Qs(n1, n1) symmetric;

variable Zs(1,1) symmetric;

variable Ys(1, n1) ;

minimize( trace(C*Qs*C'+C*Ys'*B2'+B2*Ys*C'+B2*Zs*B2'))

%minimize( trace(Qs))

subject to

Qs >= eye(2)*1e-3;

[A*Qs + Qs*A'+B1*Ys+Ys'*B1'+q*Qs+(D*D')/q+alf*gam*(M*M') Qs*N';

N*Qs -alf*eye(2)]< 0; %условие асимптотич устойчивости

[Zs Ys;

Ys' Qs]>=0;

% [Qs eye(2); eye(2) 50*eye(2)]>0;

%norm(Ys, 'fro')<=15;

cvx_end

Qsf = double(Qs)

Y=double(Ys);

K=Y/Qsf;

Z=double(Zs);

%trZ=trace(Qsf);

trZ=trace(C*Qsf*C'+C*Y'*B2'+B2*Y*C'+B2*Z*B2');

if min_tr_Z > trZ

min_tr_Z = trZ

Q_min = Qsf

K_min=K

q_min = q

alf_min=alf

end;

end;

end;

step = step*0.5;

begin_val = q_min-2*step;

end_val = q_min+2*step;

end;

Q1=Q_min

K1=K_min

q1=q_min

alf1=alf_min

A1=A+B1*K1;

С помощью разработанной программы была решена задача минимизации trace (Q) при ограничениях (5.8) и дополнительных ограничениях, обеспечивающих ограниченность коэффициентов усиления регулятора:

[Qs eye(2); eye(2) 50*eye(2)]>0;

norm(Ys, 'fro')<=15;

В результате при q01 =0.1, α01=2 получена матрица минимального инвариантного эллипсоида

Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru ,

и коэффициенты K01=[–120.0643 –75.4271] робастного регулятора по состоянию. Матрица замкнутой системы Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru имеет собственные значения [–1.6303, –73.7968]. На рисунке 5.2 показан переходный процесс в исходной нелинейной системе с полученным робастным регулятором при учете внешнего возмущения w=sin(cos(3*t)).

Рисунок 5.2. Переходный процесс в системе с робастным регулятором K01 с Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru при начальных отклонениях x0=[5 2] и действии возмущения w=sin(cos(3*t))

Для интегрирования исходной системы использовалась функция Mayat_Integr_01.

Для оценивания состояния исходной нелинейной системы с учетом неопределенных возмущений и параметрических изменений было получено на интервале [0,10с] частное решение Q(t) матричной системы сравнения

Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru (5.10)

при q =0.1, α=2, K=K01 и начальной матрице Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru . На рисунке 5.3 показаны сечения эволюционирующего инвариантного эллипса, определяемого матрицей Q(t) в дискретные моменты времени. Начальный эллипс показан пунктирной линией, эллипс, соответствующий матрице Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru показан сплошной линией.

Рисунок 5.3. Сечения эволюционирующего инвариантного эллипса, получаемые в результате численного интегрирования МСС (5.10) при учете регулятора K01

Текст программы для численного интегрирования системы сравнения представлен ниже. Для вычисления правых частей МСС (5.9) используется функция Prav_Lin_Mayat_1rob.

% Оценивание состояния маятника с неопределенными возмущениями с помощью

% матричной системы сравнения

t0=0; tk=10;

Q=Q01+eye(2);

vec_Q = [Q(:,1); Q(:,2)];

[t,H] = ode15s(@(t,vec_Q) Prav_Lin_Mayat_1rob(t,vec_Q,A01,D,q01,alf01,gam,M,N),[t0 tk],vec_Q);

MQ = [];

nh=length(H(:,1));

t(nh)

nn=1;

figure(2)

for i = 1:nn:nh

MQ = [H(i,1) H(i,2); H(i,3) H(i,4)];

MQ=(MQ+MQ')/2;

E = ellipsoid(MQ);

%pEs = projection(E, BB);

plot(E, 'b');grid on;hold on;

end;

plot(E, 'r');grid on;hold on;

function dQ=Prav_Lin_Mayat_1rob(t,vec_Q,A,D,q,alf,gam,M,N)

% Вычисление правой части матричной системы сравнения

Q = [ vec_Q(1) vec_Q(2); vec_Q(3) vec_Q(4)];

dQQ= A*Q + Q*A' +q*Q+(D*D')/q+alf*gam*(M*M')+Q*(N'*N)*Q/alf;

dQQ=(dQQ+dQQ')/2;

dQ = reshape(dQQ,4,1);

Также с помощью разработанной программы была решена задача минимизации trace Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru при ограничениях (5.8),(5.9). Получены значения q1 = 2.5, α1=0.11, матрица Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru предельного инвариантного эллипса для состояний и коэффициенты K1=[–11.7002 –6.9773] робастного регулятора по состоянию. Матрица замкнутой системы Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru имеет собственные значения [–3.0192, –3.9581]. На рисунке 5.4 показаны минимальные предельные инвариантные эллипсы для вектора состояний системы с робастными регуляторами K01 (штриховая линия) и K1 (пунктирная линия). На рисунке 5.5 показан переходный процесс в исходной нелинейной системе с полученным робастным регулятором K1 по углу (сплошная линия) и по угловой скорости (пунктирная линия) при учете внешнего возмущения w=sin(cos(3*t)).

Рисунок 5.4. Минимальные предельные инвариантные эллипсы для вектора состояний системы с робастными регуляторами K01 (штриховая линия) и K1 (сплошная линия)

Рисунок 5.5. Переходный процесс в системе с робастным регулятором K1 с Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru при начальных отклонениях x0=[5 2] и действии возмущения w=sin(cos(3*t))

Для оценивания состояния исходной нелинейной системы с учетом неопределенных возмущений и параметрических изменений было получено на интервале [0,10с] частное решение Q(t) матричной системы сравнения (5.10) при q =0.11, α=2.5, K=K1 и начальной матрице Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru . На рисунке 5.6 показаны сечения эволюционирующего инвариантного эллипсоида, определяемого матрицей Q(t) в дискретные моменты времени. Начальный эллипсоид показан пунктирной линией, эллипсоид, соответствующий матрице Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru показан сплошной линией. Отметим, что эта матрица совпадает с матрицей Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru предельного инвариантного эллипса.

Рисунок 5.3. Сечения эволюционирующего инвариантного эллипса, получаемые в результате численного интегрирования МСС (5.10) при учете регулятора K1

С помощью программы из п. 2.1 при q1 =1.8250, q2=2 произведен синтез наблюдателя состояния с постоянными коэффициентами L1 =[9.9437 30.4212]. При этом получена следующая матрица предельного инвариантного эллипса, ограничивающего ошибку оценивания

Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru , а также матрица Результаты решения задачи синтеза робастного управления для стабилизации маятника при неопределенных возмущениях и параметрических изменениях - student2.ru . Матрица наблюдателя при этом имеет собственные значения –4.9718±2.4397i.

С помощью вызова функции Observ_Mayat_Integr_01, текст которой представлен в п.2.1, получены переходные процессы в исходной нелинейной системе с робастными регуляторами с коэффициентами K01, K1 и наблюдателем состояния с постоянными коэффициентами L1 при действии внешнего возмущения w=-sin(2*cos(3*t)) и погрешности измерений угла, задаваемой датчиком случайных чисел (показаны на рисунках 5.4 и 5.5 соответственно).

Также с помощью вызова функции Prav_CS_Nabl_Mayat_1, текст которой представлен в п.2.2, получены переходные процессы в исходной нелинейной системе с робастными регуляторами с коэффициентами K01, K1 и наблюдателем состояния с зависимыми от времени и определяемыми по выражению (2.10) коэффициентами при действии внешнего возмущения w=-sin(2*cos(3*t)) и погрешности измерений угла, задаваемой датчиком случайных чисел (показаны на рисунках 5.6 и 5.7 соответственно).

Рисунок 5.4. Переходные процессы в исходной системе (сплошная и штриховая линии) с робастным регулятором K01 по выходу наблюдателя и наблюдателе (пунктирная и штрих-пунктирная линии) с постоянными коэффициентами L1 при действии возмущений и погрешностей измерений

Рисунок 5.5. Переходные процессы в исходной системе (сплошная и штриховая линии) с робастным регулятором K1 по выходу наблюдателя и наблюдателе (пунктирная и штрих-пунктирная линии) с постоянными коэффициентами L1 при действии возмущений и погрешностей измерений

Рисунок 5.6. Переходные процессы в исходной системе (сплошная и штриховая линии) с робастным регулятором K01 по выходу наблюдателя и наблюдателе (пунктирная и штрих-пунктирная линии) с определяемыми по выражению (2.10) коэффициентами при учете возмущений и погрешности измерений угла

Рисунок 5.7. Переходные процессы в исходной системе (сплошная и штриховая линии) с робастным регулятором K1 по выходу наблюдателя и наблюдателе (пунктирная и штрих-пунктирная линии) с определяемыми по выражению (2.10) коэффициентами при учете возмущений и погрешности измерений угла

Заключение

Разработанные ранее в [1-6] методы и алгоритмы анализа динамики, оценивания состояния и синтеза управления для непрерывных систем при неопределенных внешних возмущениях и параметрических изменениях реализованы в виде комплекса программ для пакета MatLab и апробированы на модели математического мятника. Полученные результаты демонстрирует их высокую эффективность в решении задач анализа, оценивания состояния и управления в условиях информационных неопределенностей и ограничений. Эффективность заключается в наиболее полном учете различных информационных ограничений и информации о неопределенностях при синтезе управления и анализе динамики, в обеспечении гарантированности получаемых оценок, в обеспечении ограничений на управление из условия реализуемости, снижении энергетических затрат на управление.

Литература

1. Маликов А.И. Методические материалы для магистров по дисциплине «Современные проблемы теории управления». Казань: КНИТУ КАИ. 2014. 98 с.

2. Баландин Д.В., Коган М.М. Синтез законов управления на основе линейных матричных неравенств. М.:Физматлит, 2007. 280 с.

3. ElBsat M. N. Finite-Time Control and Estimation of Nonlinear Systems with Disturbance Attenuation/ Dissertations (2009) Milwaukee, Wisconsin: Marquette University, 2012. 206 c.http://epublications.marquette.edu/dissertations_mu/206/

4. Поляк Б.Т., Хлебников М.В., Щербаков П. С. Нелинейные системы с ограниченными или мультипликативными возмущениями //Проблемы устойчивости и управления. Сборник научных статей, посвященный 80-летию академика В.М.Матросова. Москва: Физматлит, 2013. С. 270-299.

5. Маликов А.И. Метод матричных систем сравнения в анализе и синтезе систем управления с неопределенностями // Аналитическая механика, устойчивость и управление: Труды X Международной Четаевской конференции. Т. 2. Секция 2. Устойчивость. Казань, 12 – 16 июня 2012 г. Казань: Изд-во Казан. гос. техн. ун-та, 2012. С.360-370

6 . Guo Y, Yao Y, Wang S., Yang B, Liu K, Zhao X. Finite-time control with H-infinity constraints of linear time-invariant and time-varying systems//J Control Theory Appl. 2013, 11 (2). P. 165–172.

Наши рекомендации