L=0.5;
B=0.1;
R=1;
Jm=0.01;
Ke=0.01;
Kt=0.01;
Kp=100;
Ki=200;
Kd=10;
