Ë
    7^(he  ã                   ó>   — d dl mZmZmZmZ d dlmZmZmZm	Z	m
Z
 d„ Zy)é    )ÚcosÚsinÚMatrixÚsymbols)ÚdynamicsymbolsÚReferenceFrameÚPointÚKanesMethodÚParticlec                  ó8
  — t        d«      \  } }t        dd¬«      \  }}t        d«      \  }}t        d«      \  }}t        d«      }|j                  dd| |j                  f«      }	|	j                  d	d||j                  f«      }
t        d
«      }|j                  |d«       |j                  d||	j                  z  «      }|j                  |||	«       |j                  d||
j                  z  «      }|j                  |||
«       t        d||«      }t        d||«      }t        d«      \  }}||z  ||z  z   |j                  z  }|	|f|
| fg}||z
  ||z
  g}||z
  |||z   z
  g}t        || |g||g|¬«      }|j                  ||g|«      \  }}t        || |g||g|¬«      }|j                  ||g|«      \  }}t        ||dz  z  t        |«      z  |dz  z  ||z  z   |||z
  z  z   g||dz  z  t        |«      z  |dz   z  ||z  z
  |||z
  z  z
  gg«      }t        d|z  |dz  z  ||dz  z  t        |«      z  g||dz  z  t        |«      z  ||dz  z  gg«      }|j                   j#                  «       |j#                  «       k(  sJ ‚|j$                  j#                  «       |j#                  «       k(  sJ ‚t        d||z  ||z  z    g«      }|j#                  «       |j#                  «       k(  sJ ‚t        ||z  |||z
  z  z   | |z  |||z
  z  z
  g«      }|j#                  «       |j#                  «       k(  sJ ‚||z  ||z  z   |j                  z  }|	|f|
| fg}t        || |g||g|¬«      }|j                  ||g|«      \  }}|j#                  «       |j#                  «       k(  sJ ‚||z  |||z
  z  z   |j                  z  }|	|f|
| fg}t        || |g||g|¬«      }|j                  ||g|«      \  }}|j#                  «       |j#                  «       k(  sJ ‚||z  ||dz  z  z   |j                  z  }|	|f|
| fg}t        || |g||g|¬«      }|j                  ||g|«      \  }}t        d||z  ||dz  z  z    g«      } |j#                  «       | j#                  «       k(  sJ ‚t        || |g||g|¬«      }|j                  ||g|«      \  }}t        ||z  |||z
  dz  z  z   | |z  |||z
  dz  z  z
  g«      }!|j#                  «       |!j#                  «       k(  sJ ‚y )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"                                     úf/var/www/skyplay_api_hub/venv/lib/python3.12/site-packages/sympy/physics/mechanics/tests/test_kane4.pyÚtest_replace_qdots_in_forcer@      sÔ  € ô ˜HÓ%�F€BˆÜ˜h¨aÔ0�H€CˆÜ˜HÓ%�F€Bˆä�6‹?�D€A€qä�sÓ€AØ	�‰�C˜ " a§c¡c Ó+€AØ	�‰�C˜ " a§c¡c Ó+€Aäˆc‹
€AØ‡I�Iˆa�„Oà	�‰�C˜1˜qŸs™s™7Ó%€AØ‡M�M�!�Q˜Ôà	�‰�C˜1˜qŸs™s™7Ó%€AØ‡M�M�!�Q˜Ôä	�$˜˜1Ó	€BÜ	�$˜˜1Ó	€Bô ˜Ó(�J€CˆØ
�‰(�U˜S‘[Ñ
  A§C¡CÑ	'€BØ�"ˆg˜˜B˜3�xÐ €Fð �‰H�b˜3‘hÐ€DØ�‰H�b˜C #™IÑ&Ð'€Dä
�a˜"˜b˜ B¨ 8°DÔ
9€CØ×%Ñ% r¨2 h°Ó7�K€Cˆä
�a˜"˜b˜ B¨ 8°DÔ
9€CØ×%Ñ% r¨2 h°Ó7�K€Cˆô
 %¨!¨a°©d©(´S¸³WÑ*<¸rÀ1¹uÑ*DÀsÈRÁxÑ*OØ*/°2¸±7Ñ*;ñ+<ð )=à*+¨a°©d©(´S¸³WÑ*<ÀÀAÁ¸vÑ*EÈÈbÉÑ*PØ*/°2¸±7Ñ*;ñ+<ð )=ð'?ó AÐô " q¨1¡u¨q°!©t¡|°Q¸¸A¹±XÄÀBÃÑ5GÐ%IØ&'¨!¨Q©$¡h´°R³Ñ&8¸!¸aÀ¹d¹(Ð$Dð$Gó IÐð �O‰O×"Ñ"Ó$Ð(<×(CÑ(CÓ(EÒEÐFÐEØ�K‰K×ÑÓ Ð$;×$BÑ$BÓ$DÒDÐEÐDô ˜A  R¡¨%°"©*Ñ!4Ð5Ð7Ó8€LØ�:‰:‹<˜<×.Ñ.Ó0Ò0Ð0Ð0ô ˜3 ™8 e¨r°B©wÑ&7Ñ7Ø!˜E B™J¨°"°r±'Ñ):Ñ:ð<ó =€Là�:‰:‹<˜<×.Ñ.Ó0Ò0Ð0Ð0ð �‰(�U˜R‘ZÑ
 1§3¡3Ñ	&€BØ�"ˆg˜˜B˜3�xÐ €FÜ
�a˜"˜b˜ B¨ 8°DÔ
9€CØ×%Ñ% r¨2 h°Ó7�K€Cˆà�:‰:‹<˜<×.Ñ.Ó0Ò0Ð0Ð0à
�‰(�U˜b ™e‘_Ñ
$¨¯©Ñ	+€BØ�"ˆg˜˜B˜3�xÐ €FÜ
�a˜"˜b˜ B¨ 8°DÔ
9€CØ×%Ñ% r¨2 h°Ó7�K€Cˆà�:‰:‹<˜<×.Ñ.Ó0Ò0Ð0Ð0ð �‰(�U˜S !™V‘^Ñ
# q§s¡sÑ	*€BØ�"ˆg˜˜B˜3�xÐ €Fä
�a˜"˜b˜ B¨ 8°DÔ
9€CØ×%Ñ% r¨2 h°Ó7�K€Cˆä ! s¨2¡v°¸¸A¹±Ñ'=Ð%>Ð @ÓAÐà�:‰:‹<Ð-×4Ñ4Ó6Ò6Ð6Ð6ä
�a˜"˜b˜ B¨ 8°DÔ
9€CØ×%Ñ% r¨2 h°Ó7�K€Cˆä  r¡¨E°R¸"±W¸q±LÑ,@Ñ!@Ø!˜E B™J¨°"°r±'¸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   