ruletest4.py 682 B

1234567891011121314151617181920
  1. import sympy.physics.mechanics as _me
  2. import sympy as _sm
  3. import math as m
  4. import numpy as _np
  5. frame_a = _me.ReferenceFrame('a')
  6. frame_b = _me.ReferenceFrame('b')
  7. q1, q2, q3 = _me.dynamicsymbols('q1 q2 q3')
  8. frame_b.orient(frame_a, 'Axis', [q3, frame_a.x])
  9. dcm = frame_a.dcm(frame_b)
  10. m = dcm*3-frame_a.dcm(frame_b)
  11. r = _me.dynamicsymbols('r')
  12. circle_area = _sm.pi*r**2
  13. u, a = _me.dynamicsymbols('u a')
  14. x, y = _me.dynamicsymbols('x y')
  15. s = u*_me.dynamicsymbols._t-1/2*a*_me.dynamicsymbols._t**2
  16. expr1 = 2*a*0.5-1.25+0.25
  17. expr2 = -1*x**2+y**2+0.25*(x+y)**2
  18. expr3 = 0.5*10**(-10)
  19. dyadic = _me.outer(frame_a.x, frame_a.x)+_me.outer(frame_a.y, frame_a.y)+_me.outer(frame_a.z, frame_a.z)