45
3
import os
3
import os
4
import sys
4
import sys
5
 
5
 
 
 
6
 
 
 
7
class wiimote_data:
 
 
8
    time
 
 
9
    gyro_raw_x
 
 
10
    gyro_raw_y
 
 
11
    gyro_raw_z
 
 
12
    gyro_fast_x
 
 
13
    gyro_fast_y
 
 
14
    gyro_fast_z
 
 
15
    gyro_calib_x
 
 
16
    gyro_calib_y
 
 
17
    gyro_calib_z
 
 
18
    accel_raw_x
 
 
19
    accel_raw_y
 
 
20
    accel_raw_z
 
 
21
    A
 
 
22
    B
 
 
23
 
 
 
24
def update(time, gyro_raw_x, gyro_raw_y, gyro_raw_z, gyro_fast_x, gyro_fast_y, gyro_fast_z, gyro_calib_x, gyro_calib_y, gyro_calib_z, accel_raw_x, accel_raw_y,
accel_raw_z, A, B):
 
 
25
    for c in integrator:
 
 
26
        c.update(time, gyro_raw_x, gyro_raw_y, gyro_raw_z, gyro_fast_x, gyro_fast_y, gyro_fast_z, gyro_calib_x, gyro_calib_y, gyro_calib_z, accel_raw_x,
accel_raw_y, accel_raw_z, A, B)
 
 
27
 
 
 
28
 
 
 
29
 
 
 
30
 
 
 
31
 
 
 
32
 
 
 
33
 
6
#recup le fichier passe par ligne de commande
34
#recup le fichier passe par ligne de commande
7
 
 
 
8
if len(sys.argv) != 2 :
35
if len(sys.argv) != 2 :
9
    print "Passez un fichier en argument !"
36
    print "Passez un fichier en argument !"
10
    sys.exit(1)
37
    sys.exit(1)
...
 
...
 
21
        continue
48
        continue
22
    #print l
49
    #print l
23
    time, gyro_raw_x, gyro_raw_y, gyro_raw_z, gyro_fast_x, gyro_fast_y, gyro_fast_z, gyro_calib_x, gyro_calib_y, gyro_calib_z, accel_raw_x, accel_raw_y,
accel_raw_z, A, B = l.split(' ') 
50
    time, gyro_raw_x, gyro_raw_y, gyro_raw_z, gyro_fast_x, gyro_fast_y, gyro_fast_z, gyro_calib_x, gyro_calib_y, gyro_calib_z, accel_raw_x, accel_raw_y,
accel_raw_z, A, B = l.split(' ') 
 
 
51
    update(time, gyro_raw_x, gyro_raw_y, gyro_raw_z, gyro_fast_x, gyro_fast_y, gyro_fast_z, gyro_calib_x, gyro_calib_y, gyro_calib_z, accel_raw_x, accel_raw_y,
accel_raw_z, A, B)
24
 
52
 
25
 
53
 
26
    #print time, gyro_raw_x, gyro_raw_y, gyro_raw_z, gyro_fast_x, gyro_fast_y, gyro_fast_z, gyro_calib_x, gyro_calib_y, gyro_calib_z, accel_raw_x, accel_raw_y,
accel_raw_z, A, B
54
    #print time, gyro_raw_x, gyro_raw_y, gyro_raw_z, gyro_fast_x, gyro_fast_y, gyro_fast_z, gyro_calib_x, gyro_calib_y, gyro_calib_z, accel_raw_x, accel_raw_y,
accel_raw_z, A, B