chaos_pendulum.al 690 B

123456789101112131415161718192021222324252627282930313233
  1. CONSTANTS G,LB,W,H
  2. MOTIONVARIABLES' THETA'',PHI'',OMEGA',ALPHA'
  3. NEWTONIAN N
  4. BODIES A,B
  5. SIMPROT(N,A,2,THETA)
  6. SIMPROT(A,B,3,PHI)
  7. POINT O
  8. LA = (LB-H/2)/2
  9. P_O_AO> = LA*A3>
  10. P_O_BO> = LB*A3>
  11. OMEGA = THETA'
  12. ALPHA = PHI'
  13. W_A_N> = OMEGA*N2>
  14. W_B_A> = ALPHA*A3>
  15. V_O_N> = 0>
  16. V2PTS(N, A, O, AO)
  17. V2PTS(N, A, O, BO)
  18. MASS A=MA, B=MB
  19. IAXX = 1/12*MA*(2*LA)^2
  20. IAYY = IAXX
  21. IAZZ = 0
  22. IBXX = 1/12*MB*H^2
  23. IBYY = 1/12*MB*(W^2+H^2)
  24. IBZZ = 1/12*MB*W^2
  25. INERTIA A, IAXX, IAYY, IAZZ
  26. INERTIA B, IBXX, IBYY, IBZZ
  27. GRAVITY(G*N3>)
  28. ZERO = FR() + FRSTAR()
  29. KANE()
  30. INPUT LB=0.2,H=0.1,W=0.2,MA=0.01,MB=0.1,G=9.81
  31. INPUT THETA = 90 DEG, PHI = 0.5 DEG, OMEGA=0, ALPHA=0
  32. INPUT TFINAL=10, INTEGSTP=0.02
  33. CODE DYNAMICS() some_filename.c