2025-10-23 10:29:27 +08:00
|
|
|
|
§
|
2025-11-02 20:47:28 +08:00
|
|
|
|
�‡ûhô ã
|
2025-10-23 10:29:27 +08:00
|
|
|
|
ó — d dl Zd dlmZ d dlZd dlmZ d dlm Z dd„Z
|
|
|
|
|
|
e dk rå e d¬¦ « \ Z Z
|
|
|
|
|
|
ZZdZd Zd
|
|
|
|
|
|
Z e
|
|
|
|
|
|
e e
|
|
|
|
|
|
eeeeed ¬ ¦ « \ ZZ ed
|
|
|
|
|
|
¦ « edej › �¦ « edej › �¦ « ej d¬¦ « ej ede› d�¬¦ « ej d¦ « ej d¦ « ej d¦ « ej ¦ « ej d¦ « ej ¦ « dS dS )é N)Úsolve_discrete_lyapunov)Ú generate_ground_truth_systemc óP — |€ t j ¦ « }n t j |¦ « }| j d } |j d }
|
|
|
|
|
|
|j d } t j | df¦ « } g }
|
|
|
|
|
|
g }g }| ||
|
|
|
|
|
|
df¬¦ « }| ||| df¬¦ « }| ||| df¬¦ « }t d|› d�¦ « t d|› �¦ « t d |› �¦ « t |¦ « D ]}|| }|| }|| }|| z ||z z |z }| | z ||z z |z }| |
|
|
|
|
|
|
¦ « ¦ « | |
|
|
|
|
|
|
¦ « ¦ « |
|
|
|
|
|
|
|
|
|
|
|
|
|
¦ « ¦ « |} Œ®t d
|
|
|
|
|
|
¦ « t j |¦ « ||
|
|
|
|
|
|
¦ « }t j |¦ « || ¦ « }||fS ) u¡
|
|
|
|
|
|
使用 LTI 系统 (A, B, C, D) 仿真生�数�。
|
|
|
|
|
|
|
|
|
|
|
|
�数:
|
|
|
|
|
|
A (np.ndarray): 状�矩阵 (dx x dx)
|
|
|
|
|
|
B (np.ndarray): 输入矩阵 (dx x du)
|
|
|
|
|
|
C (np.ndarray): 观测矩阵 (dy x dx)
|
|
|
|
|
|
D (np.ndarray): �馈矩阵 (dy x du)
|
|
|
|
|
|
T (int): 轨迹长度 (时间æ¥æ•°)
|
|
|
|
|
|
sigma_process (float): è¿‡ç¨‹å™ªå£°çš„æ ‡å‡†å·® (sigma_Sigma)
|
|
|
|
|
|
sigma_measurement (float): 测é‡�å™ªå£°çš„æ ‡å‡†å·® (sigma_Gamma)
|
|
|
|
|
|
rng_seed (int, optional): 用于å¤�现的éš�机ç§�å�
|
|
|
|
|
|
|
|
|
|
|
|
返回:
|
|
|
|
|
|
tuple: (u_data, y_data)
|
|
|
|
|
|
u_data (np.ndarray): 输入轨迹 (T x du)
|
|
|
|
|
|
y_data (np.ndarray): 输出轨迹 (T x dy)
|
|
|
|
|
|
Nr é )Úsize)Úscaler u
|
|
|
|
|
|
--- 开始仿真数� (T=z) ---u 过程噪声 (sigma_Sigma): u 测�噪声 (sigma_Gamma): u 仿真完�。)
|
|
|
|
|
|
ÚnpÚrandomÚ default_rngÚshapeÚzerosÚstandard_normalÚnormalÚprintÚrangeÚappendÚsqueezeÚarrayÚreshape)ÚAÚBÚCÚDÚTÚ
|
|
|
|
|
|
sigma_processÚsigma_measurementÚrng_seedÚrngÚdxÚduÚdyÚxÚ x_historyÚ y_historyÚ u_historyÚ
|
|
|
|
|
|
u_data_genÚ
|
|
|
|
|
|
w_data_genÚ
|
|
|
|
|
|
z_data_genÚtÚuÚwÚzÚyÚx_nextÚu_dataÚy_datas ú.f:\Papers\Baysian_Inference\generateSimData.pyÚsimulate_lti_datar2 s9 € ð* ÐÝŒi×#Ò#Ñ%Ô%ˆˆåŒi×#Ò# HÑ-Ô-ˆð
|
|
|
|
|
|
Œ�Œ€BØ
|
|
|
|
|
|
Œ�Œ€BØ
|
|
|
|
|
|
Œ�Œ€Bõ Œ�"�a�ÑÔ€Að €IØ€IØ€Ið ×$Ò$¨1¨b°!¨*Ð$Ñ5Ô5€Jð —’ -°q¸"¸a°j�ÑAÔA€Jð —’Ð"3¸1¸bÀ!¸*�ÑEÔE€Jå Ð
|
|
|
|
|
|
1¨Ð
|
|
|
|
|
|
1Ð
|
|
|
|
|
|
1Ð
|
|
|
|
|
|
1Ñ2Ô2Ð2Ý Ð
|
|
|
|
|
|
8¨ Ð
|
|
|
|
|
|
8Ð
|
|
|
|
|
|
8Ñ9Ô9Ð9Ý Ð
|
|
|
|
|
|
<Ð):Ð
|
|
|
|
|
|
<Ð
|
|
|
|
|
|
<Ñ=Ô=Ð=õ �1‰XŒXð ð ˆØ �qŒMˆØ �qŒMˆØ �qŒMˆð
|
|
|
|
|
|
�‰E�A˜‘E‰M˜AÑ ˆð �Q‘˜˜Q™‘ Ñ"ˆð ×Ò˜Ÿš™œÑ%Ô%Ð%Ø×Ò˜Ÿš™œÑ%Ô%Ð%Ø×Ò˜Ÿš™œÑ%Ô%Ð%ð
|
|
|
|
|
|
ˆˆå Ð
|
|
|
|
|
|
Ñ Ô Ð õ
|
|
|
|
|
|
ŒX�iÑ
|
|
|
|
|
|
Ô
|
|
|
|
|
|
×
|
|
|
|
|
|
(Ò
|
|
|
|
|
|
(¨¨BÑ
|
|
|
|
|
|
/Ô
|
|
|
|
|
|
/€FÝ
|
|
|
|
|
|
ŒX�iÑ
|
|
|
|
|
|
Ô
|
