summaryrefslogtreecommitdiffhomepage
path: root/digital/asserv/tools/asserv/init.py
blob: f5c31fabd2fb2d58c47237b25da8a14b8453b2e5 (plain)
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
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
"""Default parameters for asserv."""
host_marcel = dict (
        scale = 0.0395840674352314, footing = 0xdd1,
        t_kp = 1, t_kd = 16,
        t_acc = 0.75, t_speed_max = 0x20, t_speed_slow = 0x10,
        a_kp = 2, a_kd = 16,
        a_acc = 0.25, a_speed_max = 0x20, a_speed_slow = 0x10,
        a0_kp = 4,
        a0_acc = 4, a0_speed_max = 0x60, a0_speed_slow = 0x10,
        a1_kp = 2,
        a1_acc = 16, a1_speed_max = 0x46, a1_speed_slow = 0x10,
        e_sat = 0x3ff, d_sat = 0x1ff,
        angle_limit = 0x1000,
        )
host_robospierre = dict (
        scale = 0.0395840674352314, footing = 0xdd1,
        t_kp = 1, t_kd = 16,
        t_acc = 0.75, t_speed_max = 0x60, t_speed_slow = 0x10,
        a_kp = 2, a_kd = 16,
        a_acc = 0.25, a_speed_max = 0x60, a_speed_slow = 0x10,
        e_sat = 0x3ff, d_sat = 0x1ff,
        angle_limit = 0x1000,
        )
host_guybrush = dict (
        aux_nb = 0,
        scale = 0.0395840674352314, footing = 0xdd1,
        t_kp = 1, t_kd = 16,
        t_acc = 0.75, t_speed_max = 0x60, t_speed_slow = 0x10,
        a_kp = 2, a_kd = 16,
        a_acc = 0.25, a_speed_max = 0x60, a_speed_slow = 0x10,
        e_sat = 0x3ff, d_sat = 0x1ff,
        angle_limit = 0x1000,
        )
host = {
        'giboulee': host_marcel,
        'marcel': host_marcel,
        'robospierre': host_robospierre,
        'guybrush': host_guybrush,
        'apbirthday': host_guybrush,
        }
target_marcel = dict (
        scale = 0.0415178942124, footing = 0xcef,
        encoder_right_correction = float (0x00ffbabf) / (1 << 24),
        t_kp = 1, t_kd = 16,
        t_acc = 0.75, t_speed_max = 0x20, t_speed_slow = 0x10,
        a_kp = 2, a_kd = 16,
        a_acc = 0.25, a_speed_max = 0x20, a_speed_slow = 0x10,
        a0_kp = 4, a0_kd = 16,
        a0_acc = 4, a0_speed_max = 0x60, a0_speed_slow = 0x10,
        a0_bd_error_limit = 256, a0_bd_speed_limit = 0x04, a0_bd_counter_limit = 10,
        a1_kp = 2,
        a1_acc = 16, a1_speed_max = 0x46, a1_speed_slow = 0x10,
        a1_bd_error_limit = 256, a1_bd_speed_limit = 0x0c, a1_bd_counter_limit = 10,
        e_sat = 0x3ff, d_sat = 0x1ff,
        angle_limit = 0x1000,
        )
target_robospierre = dict (
        scale = 0.0317975134344, footing = 0x134e,
        encoder_right_correction = float (0xffa897) / (1 << 24),
        t_kp = 1, t_kd = 16,
        t_acc = 0.75, t_speed_max = 0x60, t_speed_slow = 0x10,
        t_bd_error_limit = 256, t_bd_speed_limit = 0x08, t_bd_counter_limit = 40,
        a_kp = 2, a_kd = 16,
        a_acc = 0.5, a_speed_max = 0x60, a_speed_slow = 0x10,
        a_bd_error_limit = 128, a_bd_speed_limit = 0x08, a_bd_counter_limit = 40,
        e_sat = 0x3ff, d_sat = 0x1ff,
        angle_limit = 0x1000,
        )
target_guybrush = dict (
        aux_nb = 0,
        scale = 0.0317975134344, footing = 0x134e,
        encoder_right_correction = 0.99861627695742,
        t_kp = 1, t_kd = 16,
        t_acc = 0.75, t_speed_max = 0x60, t_speed_slow = 0x10,
        t_bd_error_limit = 256, t_bd_speed_limit = 0x08, t_bd_counter_limit = 40,
        a_kp = 2, a_kd = 16,
        a_acc = 0.5, a_speed_max = 0x60, a_speed_slow = 0x10,
        a_bd_error_limit = 128, a_bd_speed_limit = 0x08, a_bd_counter_limit = 40,
        e_sat = 0x3ff, d_sat = 0x1ff,
        r_reverse = True,
        angle_limit = 0x1000,
        )
target_apbirthday = dict (
        aux_nb = 0,
        scale = 0.0317975134344, footing = 0x1036,
        encoder_right_correction = 1.00078805775467,
        t_kp = 1, t_kd = 16,
        t_acc = 0.75, t_speed_max = 0x60, t_speed_slow = 0x10,
        t_bd_error_limit = 256, t_bd_speed_limit = 0x08, t_bd_counter_limit = 40,
        a_kp = 2, a_kd = 16,
        a_acc = 0.5, a_speed_max = 0x60, a_speed_slow = 0x10,
        a_bd_error_limit = 128, a_bd_speed_limit = 0x08, a_bd_counter_limit = 40,
        e_sat = 0x3ff, d_sat = 0x1ff,
        l_reverse = True,
        angle_limit = 0x1000,
        )
target = {
        'giboulee': target_marcel,
        'marcel': target_marcel,
        'robospierre': target_robospierre,
        'guybrush': target_guybrush,
        'apbirthday':target_apbirthday
        }