GSM_2_3.m 1.2 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758
  1. % Aufgabe 2.3
  2. % GSM mit Propeller
  3. clc;
  4. clear;
  5. close all;
  6. %% 2.3
  7. % iG = 1/RG*uG-kG/RG*wG
  8. % xred = [phiG, wG, wP]
  9. syms pGP wG wP;
  10. syms kG RG dvG dcG dGP cGP JG dpP dvP dqP dcP JP;
  11. syms Mext uG;
  12. % Gleichungssystem
  13. eq1 = sym(wG - wP);
  14. eq2 = sym((kG*(1/RG*uG-kG/RG*wG) - dvG*wG - dcG - (wG - wP)*dGP - pGP*cGP)/JG);
  15. eq3 = sym(((wG - wP)*dGP + pGP*cGP - dqP*wP^2 - dvP*wP - Mext - dcP)/JP);
  16. xred = [pGP, wG, wP];
  17. ured = [uG, Mext];
  18. dx = [eq1; eq2; eq3];
  19. sol = solve(dx == [0; 0; 0], [pGP, wG, wP]);
  20. Aredl = jacobian(dx, xred)
  21. Bredl = jacobian(dx, ured)
  22. % trivial
  23. credl = [0 0 1]
  24. dredl = [0 0]
  25. % Auswertung (Werte von GSM_2_2)
  26. LG = 1.4e-3; % H
  27. RG = .46; % Ohm
  28. kG = .1; % N m A^-1
  29. JG = 12.4e-3; % kg m^2
  30. dcG = .152; % N m
  31. dvG = 1.8e-3; % N m s rad^-1
  32. JP = 32.5e-3; % kg m^2
  33. dcP = .169; % N m
  34. dvP = 2.7e-3; % N m s rad^-1
  35. dqP = 1e-4; % N m s^2 rad^-2
  36. cGP = .6822; % N m rad^-1
  37. dGP = 1e-5; % N m s rad^-1
  38. uG = 5.6;
  39. Mext = 0;
  40. xredR = [
  41. double(subs(sol.pGP));
  42. double(subs(sol.wG));
  43. double(subs(sol.wP))
  44. ]
  45. % erste Ruhelage
  46. xredR1 = [xredR(2), xredR(4), xredR(6)]
  47. % zweite Ruhelage
  48. xredR2 = [xredR(1), xredR(3), xredR(5)]
  49. % die Ruhelage des reduzierten Systems ist gleich, da bei der Ruhelage sich
  50. % weder uG oder wG ändern dürfen