Курсовая работа: Нелинейные САУ

if (abs(P_w)>abs(P_w1)) P_w1=P_w;

if (abs(Q_w)>abs(Q_w1)) Q_w1=Q_w;

if (P_w<P_w_min) P_w_min = P_w;

if (P_w1==0) P_w1=P_w1+0.01;

if (Q_w1==0) Q_w1=Q_w1+0.01;

};

};

float KmasX =(float)(xmax-Xc-100)/P_w1,

KmasY =(float)(ymax-Yc-100)/Q_w1;

if (KmasX<0) KmasX=-KmasX; if (KmasY<0) KmasY=-KmasY;

if (KmasX>=220) KmasX=150;

if (KmasY>=140) KmasY=100;

if (err==0) {KmasX=KmasX*4; KmasY=KmasY*4;};

w = 0;

if(((Kos*Ko-(To+Tpr)*w*w)*(Kos*Ko-(To+Tpr)*w*w)+

(w+Tpr*Kos*Ko*w-To*Tpr*w*w*w)*(w+Tpr*Kos*Ko*w-To*Tpr*w*w*w))!=0){

P_w = KmasX*(Ko*w*Tg*(w+Tpr*Kos*Ko*w-To*Tpr*w*w*w)+

(Kos*Ko*Ko-(To+Tpr)*Ko*w*w))/

((Kos*Ko-(To+Tpr)*w*w)*(Kos*Ko-(To+Tpr)*w*w)+

(w+Tpr*Kos*Ko*w-To*Tpr*w*w*w)*(w+Tpr*Kos*Ko*w-To*Tpr*w*w*w));

Q_w = KmasY*(Tg*(Kos*Ko*Ko*w-(To+Tpr)*Ko*w*w)-

Ko*(w+Tpr*Kos*Ko*Ko*w-Ko*To*Tpr*w*w*w))/

((Kos*Ko-(To+Tpr)*w*w)*(Kos*Ko-(To+Tpr)*w*w)+

(w+Tpr*Kos*Ko*w-To*Tpr*w*w*w)*(w+Tpr*Kos*Ko*w-To*Tpr*w*w*w));

moveto(Xc+P_w,Yc-Q_w); };

setcolor(Color);

setcolor(9);

line(Xc+P_w_min*KmasX,10,Xc+P_w_min*KmasX,ymax-10);

gotoxy(2,5);