
    \he                     >    S SK JrJrJrJr  S SKJrJrJrJ	r	J
r
  S rg)    )cossinMatrixsymbols)dynamicsymbolsReferenceFramePointKanesMethodParticlec                  	   [        S5      u  p[        SSS9u  p#[        S5      u  pE[        S5      u  pg[        S5      nUR                  SSXR                  45      n	U	R                  S	SXR                  45      n
[        S
5      nUR                  US5        UR                  SXiR                  -  5      nUR                  XU	5        UR                  SXjR                  -  5      nUR                  XU
5        [        SX5      n[        SX5      n[        S5      u  nnUU-  UU-  -   UR                  -  nU	U4U
U* 4/nXB-
  XS-
  /nXB-
  XRU-   -
  /n[        XU/XE/US9nUR                  X/U5      u  nn[        XU/XE/US9nUR                  X/U5      u  nn[        XvS-  -  [        U5      -  US-  -  UU-  -   UXT-
  -  -   /XvS-  -  [        U5      -  US-  * -  UU-  -
  UXT-
  -  -
  //5      n[        SU-  US-  -  XvS-  -  [        U5      -  /XvS-  -  [        U5      -  XvS-  -  //5      nUR                   R#                  5       UR#                  5       :X  d   eUR$                  R#                  5       UR#                  5       :X  d   e[        SUU-  UU-  -   * /5      nUR#                  5       UR#                  5       :X  d   e[        UU-  UXT-
  -  -   U* U-  UXT-
  -  -
  /5      nUR#                  5       UR#                  5       :X  d   eUU-  UU-  -   UR                  -  nU	U4U
U* 4/n[        XU/XE/US9nUR                  X/U5      u  nnUR#                  5       UR#                  5       :X  d   eUU-  UXT-
  -  -   UR                  -  nU	U4U
U* 4/n[        XU/XE/US9nUR                  X/U5      u  nnUR#                  5       UR#                  5       :X  d   eUU-  UUS-  -  -   UR                  -  nU	U4U
U* 4/n[        XU/XE/US9nUR                  X/U5      u  nn[        SUU-  UUS-  -  -   * /5      n UR#                  5       U R#                  5       :X  d   e[        XU/XE/US9nUR                  X/U5      u  nn[        UU-  UXT-
  S-  -  -   U* U-  UXT-
  S-  -  -
  /5      n!UR#                  5       U!R#                  5       :X  d   eg )Nzq1, q2   )levelzu1, u2zl, mNAAxisBOr   PQApBpzsigma, delta)kd_eqs      )r   r   r   	orientnewzr	   set_vel	locatenewxv2pt_theoryr   r
   kanes_equationsr   r   r   mass_matrixexpandforcing)"q1q2qd1qd2u1u2lmr   r   r   r   r   r   r   r   sigdeltaTaforceskde1kde2KM1fr1fstar1KM2fr2fstar2forcing_matrix_expectedmass_matrix_expectedfr1_expectedfr2_expectedfr1_cubic_expectedfr2_cubic_expecteds"                                     `/var/www/auris/envauris/lib/python3.13/site-packages/sympy/physics/mechanics/tests/test_kane4.pytest_replace_qdots_in_forcer@      sx    H%FBha0HCH%FB6?DAsA	C"cc+A	C"cc+Ac
AIIaO	C1ss7%AMM!	C1ss7%AMM!	$	B	$	B (JC
(US[
 ACC	'B"gB3x F HbhDHb#I&'D
abB8D
9C%%rh7KC
abB8D
9C%%rh7KC
 %!d(SW*<r1u*DsRx*O*/27*;+< )=*+d(SW*<Av*Eb*P*/27*;+< )='? A "q1uq!t|QAXB5G%I&'Q$hR&8!d($D$G I OO""$(<(C(C(EEFEKK $;$B$B$DDED AR%"*!4578L::<<..0000 38erw&77!EBJ"')::< =L::<<..0000 (URZ
133	&B"gB3x F
abB8D
9C%%rh7KC::<<..0000
(Ube_
$	+B"gB3x F
abB8D
9C%%rh7KC::<<..0000 (US!V^
#qss	*B"gB3x F
abB8D
9C%%rh7KC!s2vA'=%> @A::<-446666
abB8D
9C%%rh7KCrERWqL,@!@!EBJ"'A)==!? @ ::<-446666    N)sympyr   r   r   r   sympy.physics.mechanicsr   r   r	   r
   r   r@    rA   r?   <module>rE      s    - -? ?h7rA   