-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathdspace.py
More file actions
35 lines (29 loc) · 747 Bytes
/
dspace.py
File metadata and controls
35 lines (29 loc) · 747 Bytes
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
import numpy as np
from scipy.signal import cont2discrete
dt = 0.01
A = np.zeros((6,6))
B = np.zeros((6,3))
C = np.zeros((6,6))
D = np.zeros((6,3))
A[0,3] = 1
A[1,4] = 1
A[2,5] = 1
B[3,0] = 1
B[4,1] = 1
B[5,2] = 1
d_system = cont2discrete((A, B, C, D), dt, 'euler')
print('Euler\n')
print('dA =\n', d_system[0])
print('dB =\n', d_system[1])
d_system = cont2discrete((A, B, C, D), dt, 'zoh')
print('zoh\n')
print('dA =\n', d_system[0])
print('dB =\n', d_system[1])
d_system = cont2discrete((A, B, C, D), dt, 'backward_diff')
print('backward_diff\n')
print('dA =\n', d_system[0])
print('dB =\n', d_system[1])
d_system = cont2discrete((A, B, C, D), dt, 'bilinear')
print('bilinear\n')
print('dA =\n', d_system[0])
print('dB =\n', d_system[1])