Ë
    ßGìj—*  ã                   ó  — d Z ddlmZ ddlZddlmZ ddlZddlmZ ddl	m
Z ddlmZ ddlmZ ddlmZ dd	lmZ dd
lmZmZ ddlmZ ddlmZmZ ddlmZ eZeZdedej<                  fd„Zej@                  d„ «       Z!d„ Z"d„ Z#d„ Z$d„ Z%d„ Z&d„ Z'	 	 d$d„Z(ddejR                  ejR                  dœd„Z* eejV                  d¬«      defd„«       Z, eejZ                  d¬ «      d!„ «       Z.d"„ Z/d#„ Z0e.jc                  e/e0«       y)%a  JAX-based Dormand-Prince ODE integration with adaptive stepsize.

Integrate systems of ordinary differential equations (ODEs) using the JAX
autograd/diff library and the Dormand-Prince method for adaptive integration
stepsize calculation. Provides improved integration accuracy over fixed
stepsize integration methods.

For details of the mixed 4th/5th order Runge-Kutta integration method, see
https://doi.org/10.1090/S0025-5718-1986-0815836-3

Adjoint algorithm based on Appendix C of https://arxiv.org/pdf/1806.07366.pdf
é    )ÚpartialN)ÚCallable)Úapi_util)Úcore)Úcustom_derivatives)Úlax)Úpromote_dtypes_inexact)Úsafe_mapÚsafe_zip©Úravel_pytree)Útree_leavesÚtree_map)Úlinear_utilÚfÚ
debug_infoc                 óX   — t        t        j                  | |¬«      |«      j                  S )N)r   )Úravel_first_arg_ÚluÚ	wrap_initÚcall_wrapped)r   Úunravelr   s      úXC:\Users\Stabi\Downloads\virtual-tryon(1)\venv\Lib\site-packages\jax/experimental/ode.pyÚravel_first_argr   1   s$   € Ü	œ"Ÿ,™, q°ZÔ@Ø!ó
#ß#/¡<ð0ó    c                 óD   —  ||«      } | |g|¢­Ž }t        |«      \  }}|S ©Nr   )r   r   Úy_flatÚargsÚyÚansÚans_flatÚ_s           r   r   r   5   s+   € áˆfƒo€!Ù	ˆ!ˆˆdŠ€#Ü˜SÓ!�+€(ˆAØ	€/r   c           
      ó  — t        j                  g d¢| j                  ¬«      }| |j                  | j                  «      t        j                  ||«      z  z   }t        j
                  t        | |||d   |d   |«      «      S )N)ge
•g¢¹?r   gÁ×GÇÙ?ggËÍ$WŠž¿gü€·l,®?gh¹
y§¿gœHnø^z˜?©Údtyper   éÿÿÿÿ)ÚjnpÚarrayr&   ÚastypeÚdotÚasarrayÚfit_4th_order_polynomial)Úy0Úy1ÚkÚdtÚ	dps_c_midÚy_mids         r   Úinterp_fit_doprir4   <   sq   € ä�i‰iò ?ð GIÇhÁhôP€)ð ˆr�y‰y˜Ÿ™Ó"¤S§W¡W¨Y¸Ó%:Ñ:Ñ
:€%Ü	�‰Ô-¨b°"°e¸Q¸q¹TÀ1ÀRÁ5È"ÓMÓ	NÐNr   c                 ó   — |j                  | j                  «      }d|z  |z  d|z  |z  z   d| z  z
  d|z  z
  d|z  z   }d|z  |z  d|z  |z  z
  d| z  z   d|z  z   d	|z  z
  }d
|z  |z  ||z  z   d| z  z
  d|z  z
  d|z  z   }||z  }	| }
||||	|
fS )Ng       Àg       @g       @g      0@ç      @g      @g      2@g      ,@g      @@g      Àg      &@)r*   r&   )r.   r/   r3   Údy0Údy1r1   ÚaÚbÚcÚdÚes              r   r-   r-   E   sÍ   € Ø	‡y�y�—‘Ó€"Ø	ˆ"�fˆS�j�2�b‘5˜‘9Ñ  2¡Ñ%¨¨B©Ñ.°°U±Ñ:€!Ø	ˆ"�uˆS�y�2�b‘5˜‘9Ñ˜s 2™vÑ%¨¨B©Ñ.°°U±Ñ:€!Ø	ˆ"�fˆS�j�b˜‘fÑ˜s 2™vÑ%¨¨B©Ñ.°°U±Ñ:€!Øˆ3�h€!Ø€!Ø	
ˆAˆq�!�QˆÐr   c           	      ó  — t        ||«      \  }}|j                  }|t        j                  |«      |z  z   }t        j                  j                  ||j                  |«      z  «      }	t        j                  j                  ||j                  |«      z  «      }
t        j                  |	dk  |
dk  z  dd|	z  |
z  «      }||j                  |«      |z  z   } | |||z   «      }t        j                  j                  ||z
  |j                  |«      z  «      |z  }t        j                  |
dk  |dk  z  t        j                  d|dz  «      dt        j                  |
|«      z  d|dz   z  z  «      }t        j                  d|z  |«      S )Ngñhãˆµøä>g�íµ ÷Æ°>g{®Gáz„?gVçž¯Ò<gü©ñÒMbP?ç      ð?g      Y@)
r	   r&   r(   ÚabsÚlinalgÚnormr*   ÚwhereÚmaximumÚminimum)ÚfunÚt0r.   ÚorderÚrtolÚatolÚf0r&   ÚscaleÚd0Úd1Úh0r/   Úf1Úd2Úh1s                   r   Úinitial_step_sizerS   N   sT  € ô " " bÓ)�&€"€bØ
�(‰(€%à
”—‘˜“˜tÑ#Ñ
#€%Ü
‡z�z‡��r˜EŸL™L¨Ó/Ñ/Ó0€"Ü
‡z�z‡��r˜EŸL™L¨Ó/Ñ/Ó0€"ä
‡y�y�"�t‘)  T¡	Ñ*¨D°$¸±)¸b±.ÓA€"Ø	ˆB�I‰I�eÓ˜rÑ!Ñ!€"Ù
ˆ2ˆr�B‰wÓ€"Ü
‡z�z‡�˜˜R™ 5§<¡<°Ó#6Ñ6Ó7¸"Ñ<€"ä
‡y�y�"˜‘+ "¨¡+Ñ.Ü—‘˜D " t¡)Ó,ØœŸ™ B¨Ó+Ñ+°°u¸r±zÑ1BÑCóE€"ô 
�‰�T˜B‘Y Ó	#Ð#r   c           	      ó  ‡ ‡‡‡‡‡‡— t        j                  g d¢‰j                  ¬«      Št        j                  g d¢g d¢g d¢g d¢g d¢g d¢g‰j                  ¬«      Št        j                  g d¢‰j                  ¬«      }t        j                  g d	¢‰j                  ¬«      }ˆˆˆˆˆ ˆˆfd
„}t        j                  d‰j                  d   f‰j                  «      j
                  dd d …f   j                  ‰«      }t        j                  dd||«      }‰j                  ‰j                  «      t        j                  ||«      z  ‰z   }	‰j                  ‰j                  «      t        j                  ||«      z  }
|d   }|	||
|fS )N)çš™™™™™É?g333333Ó?gš™™™™™é?gÇqÇqì?r?   r?   r   r%   )rU   r   r   r   r   r   r   )g333333³?gÍÌÌÌÌÌÌ?r   r   r   r   r   )gŸôIŸôIï?gÞÝÝÝÝÝÀgÇqÇq@r   r   r   r   )g�qÃìž@gä •Ò1'Àg�R<6R¥#@gE3ºžœÒ¿r   r   r   )g°¨õ+Å@g„>øàƒ%Àg‹r£Ð!@gÑE]tÑÑ?g/ÌÙp‰�Ñ¿r   r   )gUUUUUU·?r   gûVšIÀÜ?gUUUUUÕä?gŒ·²Ï¡Ô¿g1Ã0ÃÀ?r   )g âd’jíJ?r   g€ÿ¸ÆÍ9g¿gà“>é“>™?g8Üá‹\¡¿g„–ÎOc›œ?g‘¿c                 óô   •— ‰
‰‰| dz
     z  z   }‰‰j                  ‰j                  «      t        j                  ‰| dz
  d d …f   |«      z  z   } ‰	||«      }|j                  | d d …f   j                  |«      S )Né   )r*   r&   r(   r+   ÚatÚset)Úir0   ÚtiÚyiÚftÚalphaÚbetar1   rK   ÚfuncrG   r.   s        €€€€€€€r   Úbody_funz"runge_kutta_step.<locals>.body_funv   sr   ø€ Ø	ˆb�5˜˜1™‘:‰oÑ	€BØ	ˆb�i‰i˜Ÿ™Ó!¤C§G¡G¨D°°1±²a°©L¸!Ó$<Ñ<Ñ	<€BÙ	ˆb�"‹€BØ�4‰4�’1�‰:�>‰>˜"ÓÐr   é   r   rW   r'   )r(   r)   r&   ÚzerosÚshaperX   rY   r   Ú	fori_loopr*   r+   )r`   r.   rK   rG   r1   Úc_solÚc_errorra   r0   r/   Úy1_errorrP   r^   r_   s   `````       @@r   Úrunge_kutta_stepri   d   s;  þ€ ä
�)‰)Ò<ÀBÇHÁHÔ
M€%Ü	�‰Ú Ò"AÚ.ÚGÚLÚEð	Gð
 �H‰Hô
€$ô �)‰)ÚDØ�H‰Hô€%ô �I‰Iò ð �8‰8ô€'÷
ò ô 
‡i�i��B—H‘H˜Q‘KÐ  "§(¡(Ó+×.Ñ.¨q²!¨tÑ4×8Ñ8¸Ó<€!Ü	‡m�m�A�q˜( AÓ&€!à	‡y�y�—‘ÓœSŸW™W U¨AÓ.Ñ.°Ñ3€"Ø�Y‰Y�r—x‘xÓ ¤3§7¡7¨7°AÓ#6Ñ6€(Øˆ�u€"Ø	ˆR�˜1Ð	Ðr   c                 ót   — t        j                  | «      r| j                  dz  | j                  dz  z   S | dz  S )Né   )r(   ÚiscomplexobjÚrealÚimag)Úxs    r   Úabs2rp   „   s4   € Ü×Ñ�aÔØ�6‰6�Q‰;˜Ÿ™ 1™Ñ$Ð$à�‰6€Mr   c                 ó$  — ||t        j                  t        j                  |«      t        j                  |«      «      z  z   }| |j                  | j                  «      z  }t        j
                  t        j                  t        |«      «      «      S r   )r(   rD   r@   r*   r&   ÚsqrtÚmeanrp   )Úerror_estimaterI   rJ   r.   r/   Úerr_tolÚ	err_ratios          r   Úmean_error_ratiorw   Š   sa   € Ø�4œ#Ÿ+™+¤c§g¡g¨b£k´3·7±7¸2³;Ó?Ñ?Ñ?€'Ø˜wŸ~™~¨n×.BÑ.BÓCÑC€)Ü	�‰”#—(‘(œ4 	›?Ó+Ó	,Ð,r   c                 óÜ   — t        j                  |dk  d|«      }t        j                  |t        j                  |d|z  z  |z  |«      «      }t        j                  |dk(  | |z  | |z  «      S )z%Compute optimal Runge-Kutta stepsize.rW   r?   g      ð¿r   )r(   rC   rE   rD   )Ú	last_steprw   ÚsafetyÚifactorÚdfactorrH   Úfactors          r   Úoptimal_step_sizer~   �   sm   € ô �I‰IÐ&¨Ñ*¨C°Ó9€'ä�;‰;�wÜ—k‘kÐ"2°T¸E±\Ñ"BÀVÑ"KÈWÓUóW€&ä	�‰Ð# qÑ(¨)°gÑ*=¸yÈ6Ñ?QÓ	RÐRr   g„÷CÖ”N>©rI   rJ   ÚmxstepÚhmaxc          	      ó~  — t        |«      D ]A  }t        |t        j                  «      rŒt        j                  |«      rŒ4t        d|› d�«      ‚ t        j                  |j                  t        j                  «      st        d|› d�«      ‚t        j                  | ||d   g|¢­Ž \  }	}
t        |	||||||g|¢|
¢­Ž S )a–  Adaptive stepsize (Dormand-Prince) Runge-Kutta odeint implementation.

  Args:
    func: function to evaluate the time derivative of the solution `y` at time
      `t` as `func(y, t, *args)`, producing the same shape/structure as `y0`.
    y0: array or pytree of arrays representing the initial value for the state.
    t: array of float times for evaluation, like `jnp.linspace(0., 10., 101)`,
      in which the values must be strictly increasing.
    *args: tuple of additional arguments for `func`, which must be arrays
      scalars, or (nested) standard Python containers (tuples, lists, dicts,
      namedtuples, i.e. pytrees) of those types.
    rtol: float, relative local error tolerance for solver (optional).
    atol: float, absolute local error tolerance for solver (optional).
    mxstep: int, maximum number of steps to take for each timepoint (optional).
    hmax: float, maximum step size allowed (optional).

  Returns:
    Values of the solution `y` (i.e. integrated system values) at each time
    point in `t`, represented as an array (or pytree of arrays) with the same
    shape/structure as `y0` except with a new leading axis of length `len(t)`.
  z@The contents of odeint *args must be arrays or scalars, but got Ú.z&t must be an array of floats, but got r   )r   Ú
isinstancer   ÚTracerÚvalid_jaxtypeÚ	TypeErrorr(   Ú
issubdtyper&   Úfloatingr   Úclosure_convertÚ_odeint_wrapper)r`   r.   ÚtrI   rJ   r€   r�   r   ÚargÚ	convertedÚconstss              r   Úodeintr�   ˜   s¹   € ô, ˜Ö€cÜ�cœ4Ÿ;™;Õ'´×0BÑ0BÀ3Õ0GÜØ
JÈ3È%ÈqÐQóSð Sð ô 
�‰˜Ÿ™¤§¡Ô	.Ü
Ð<¸Q¸C¸qÐAÓ
BÐBä(×8Ñ8¸¸rÀ1ÀQÁ4ÐOÈ$ÒOÑ€)ˆVÜ	˜ D¨$°¸¸bÀ!Ð	TÀdÐ	TÈVÒ	TÐTr   )r   rW   rk   é   é   )Ústatic_argnumsr`   c           	      óÂ   — t        |«      \  }}t        j                  d| |i «      }	t        | ||	«      } t	        | ||||||g|¢­Ž }
 t        j                  |«      |
«      S )Nr�   )r   r   r   r   Ú_odeintÚjaxÚvmap)r`   rI   rJ   r€   r�   r.   Útsr   r   ÚdebugÚouts              r   r‹   r‹   ¸   se   € ä˜RÓ �+€"€gÜ
×
Ñ
˜h¨¨d°BÓ
7€%Ü	˜˜w¨Ó	.€$Ü��d˜D &¨$°°BÐ>¸Ò>€#Ø	Œ�‰�'Ó	˜3Ó	Ðr   )Únondiff_argnumsc                 óV  ‡ ‡‡‡‡‡‡— ˆˆ fd„Šˆˆˆˆˆfd„} ‰||d   «      }	t        j                  t        ‰|d   |d‰‰|	«      d‰¬«      }
t        j                  |gdz  «      }||	|d   |
|d   |g}t	        j
                  |||dd  «      \  }}t        j                  |d    |f«      S )	Nc                 ó   •—  ‰| |g‰¢­Ž S r   © )r    rŒ   r   r`   s     €€r   Ú<lambda>z_odeint.<locals>.<lambda>Â   s   ø€ ‘t˜A˜qÐ( 4Ó(r   c                 óê   •‡— ˆˆfd„}ˆ
ˆˆˆfd„}t        j                  ||dg| z   «      ^}} | \  }}}}}}‰|z
  ||z
  z  }t        j                  ||j	                  |j
                  «      «      }	| |	fS )Nc                 ó:   •— | \  }}}}}}}|‰k  |‰k  z  |dkD  z  S )Nr   rž   )ÚstaterZ   r#   rŒ   r1   r€   Útarget_ts        €€r   Úcond_funz+_odeint.<locals>.scan_fun.<locals>.cond_funÆ   s3   ø€ Ø"Ñ€aˆˆAˆq�"�a˜Ø�(‰l˜q 6™zÑ*¨b°1©fÑ5Ð5r   c                 óH  •— | \  }}}}}}}t        ‰||||«      \  }}	}
}||z   }t        |
‰‰||«      }t        ||||«      }t        j                  t        ||«      d‰¬«      }|dz   ||	||||g}|dz   ||||||g}t        t        t        j                  |dk  «      ||«      S )Nç        ©ÚminÚmaxrW   r?   )	ri   rw   r4   r(   Úclipr~   Úmapr   rC   )r¢   rZ   r    r   rŒ   r1   Úlast_tÚinterp_coeffÚnext_yÚnext_fÚnext_y_errorr0   Únext_tÚerror_ratioÚnew_interp_coeffÚnewÚoldrJ   Úfunc_r�   rI   s                    €€€€r   ra   z+_odeint.<locals>.scan_fun.<locals>.body_funÊ   sÈ   ø€ Ø-2Ñ*€aˆˆAˆq�"�f˜lÜ(8¸ÀÀ1ÀaÈÓ(LÑ%€fˆf�l AØ�2‰v€fÜ$ \°4¸¸qÀ&ÓI€kÜ)¨!¨V°Q¸Ó;ÐÜ�8‰8Ô% b¨+Ó6¸BÀDÔI€bà�‰U�F˜F F¨B°QÐ8HÐI€cØ�‰U˜ ¨¨B°¸LÐI€cÜ”œŸ™ K°2Ñ$5Ó6¸¸SÓAÐAr   r   )r   Ú
while_loopr(   Úpolyvalr*   r&   )Úcarryr£   r¤   ra   r#   rŒ   r¬   r­   Úrelative_output_timeÚy_targetrJ   r¶   r�   r€   rI   s    `        €€€€€r   Úscan_funz_odeint.<locals>.scan_funÄ   s~   ù€ õ6÷
Bô —‘˜x¨°A°3¸±;Ó?€I€AˆØ',Ñ$€A€qˆ!ˆQ�˜Ø$ vÑ-°!°f±*Ñ=ÐÜ�{‰{˜<Ð)=×)DÑ)DÀ\×EWÑEWÓ)XÓY€HØ�(ˆ?Ðr   r   r’   r¦   r§   é   rW   )r(   rª   rS   r)   r   ÚscanÚconcatenate)r`   rI   rJ   r€   r�   r.   r˜   r   r¼   rK   r1   r­   Ú
init_carryr#   Úysr¶   s   `````  `       @r   r•   r•   À   s®   þ€ ä
(€%÷ð ñ0 ˆR��A‘Ó€"Ü
‡x�xÔ! %¨¨A©°°A°t¸TÀ2ÓFÈBÐTXÔY€"Ü—‘˜B˜4 !™8Ó$€,Ø�B˜˜1™˜r 2 a¡5¨,Ð7€*Ü
�(‰(�8˜Z¨¨A¨B¨Ó
0�%€!€RÜ	�‰˜"˜T™( B˜Ó	(Ð(r   c           	      ó4   — t        | ||||||g|¢­Ž }||||ffS r   )r•   )	r`   rI   rJ   r€   r�   r.   r˜   r   rÁ   s	            r   Ú_odeint_fwdrÃ   ã   s.   € Üˆt�T˜4 ¨¨r°2Ð=¸Ò=€"Ø	ˆb�"�dˆ^Ð	Ðr   c           
      óˆ  ‡ ‡‡‡‡‡‡‡‡‡— |\  ŠŠŠˆ fd„Š‰d   }g }d}	ˆˆˆˆ ˆˆˆˆˆˆf
d„}
‰d   dt        t        j                  ‰«      f}t        j                  |
|t        j
                  t        ‰«      dz
  dd«      «      \  \  }}	}}t        j                  t        j                  |	g«      |d d d…   g«      }||g|¢­S )Nc                 ó`   •— | ^}}}t        j                  ‰|| g|¢­Ž \  }}| g ||«      ¢­S )z9Original system augmented with vjp_y, vjp_t and vjp_args.)r–   Úvjp)	Úaugmented_staterŒ   r   r    Úy_barr#   Úy_dotÚvjpfunr`   s	           €r   Úaug_dynamicsz!_odeint_rev.<locals>.aug_dynamicsê   sA   ø€ à"€L€A€uˆqô —G‘G˜D ! a RÐ/¨$Ò/�M€Eˆ6ØˆFÐ#‘V˜E“]Ñ#Ð#r   r'   r¦   c           
      ól  •
— | \  }}}t        j                   ‰
‰|   ‰|   g‰¢­Ž ‰|   «      j                  }||z
  }t        ‰	‰|   |||ft        j                  ‰|    ‰|dz
      g«      g‰¢­‰‰‰‰dœŽ\  }}}}t        t        j                  d«      |||f«      \  }}}|‰|dz
     z   }|||f|fS )NrW   r   )r(   r+   rm   r�   r)   r   ÚopÚ
itemgetter)r¹   rZ   rÈ   Út0_barÚargs_barÚt_barr#   r   rJ   rË   r`   Úgr�   r€   rI   r˜   rÁ   s          €€€€€€€€€€r   r¼   z_odeint_rev.<locals>.scan_funö   sñ   ø€ Ø#Ñ€Eˆ6�8ô �G‰G‘D˜˜A™  1¡Ð-¨Ò-¨q°©tÓ4×9Ñ9€EØ�e‰^€Fä!'Ø�r˜!‘u˜e V¨XÐ6Ü�	‰	�B�q‘E�6˜B˜q 1™u™I˜:Ð&Ó'ð"?ð 
ñ"?ð ˜t¨F¸ò"?Ñ€A€uˆf�hô '¤r§}¡}°QÓ'7¸%ÀÈÐ9RÓSÑ€Eˆ6�8à�A�a˜!‘e‘HÑ€EØ�6˜8Ð$ eÐ+Ð+r   rW   r   )	r   r(   Ú
zeros_liker   r¾   ÚarangeÚlenr¿   r)   )r`   rI   rJ   r€   r�   ÚresrÒ   rÈ   Úts_barrÏ   r¼   rÀ   rÐ   Ú
rev_ts_barr   rË   r˜   rÁ   s   ````` `       @@@@r   Ú_odeint_revrÙ   ç   s½   ÿù€ Ø�,€"€bˆ$ô$ð ˆB‰%€%Ø€&Ø€&÷,õ ,ð  �"‘�rœ8¤C§N¡N°DÓ9Ð:€*Ü*-¯(©(Ø�
œCŸJ™J¤s¨2£w°¡{°A°rÓ:ó+<Ñ'Ñ€5ˆ&�(˜Zä�?‰?œCŸI™I v hÓ/°¹D¸b¸DÑ1AÐBÓC€&Ø
�Ð	#˜(Ñ	#Ð#r   )gÍÌÌÌÌÌì?g      $@rU   r6   )2Ú__doc__Ú	functoolsr   ÚoperatorrÍ   Úcollections.abcr   r–   r   Ú	jax.numpyÚnumpyr(   Újax._srcr   r   r   Újax._src.numpy.utilr	   Újax._src.utilr
   r   Újax.flatten_utilr   Újax.tree_utilr   r   r   r   r«   ÚzipÚ	DebugInfor   Útransformation2r   r4   r-   rS   ri   rp   rw   r~   Úinfr�   Újitr‹   Ú
custom_vjpr•   rÃ   rÙ   Údefvjprž   r   r   Ú<module>rì      s  ðñõ Û Ý $ã 
Ý Ý Ý Ý "Ý Ý 6ß ,Ý )ß /Ý &à€Ø€ð0�xð 0°d·n±nó 0ð ×Ññó ðòOòò$ò,ò@ò-ð
 HLØ),óSð %+°ÀÇÁÈcÏgÉgô Uñ@ 	ˆ�‰ Ô1ð ˜(ò  ó 2ð ñ 	ˆ�‰¨Ô9ñ )ó :ð )òDò#$ðJ ‡�ˆ{˜KÕ (r   