Meta-Terminal-III/check_id.py at 2023-master · Meta-Team/Meta-Terminal-III · GitHub

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
import sys

if __name__ == '__main__':
    config_list = open(sys.argv[1], 'r').read().splitlines()
    motor_dict = {200 + i : '' for i in range(1, 12)}
    x200_list = [''] * 4
    x1FF_list = [''] * 4
    x2FF_list = [''] * 4
    for line in config_list:
        motor_type, motor_name, motor_id = line.split()
        motor_id = int(motor_id)
        rx_id = 0
        if motor_type == '3508' or motor_type == '2006':
            if motor_id > 8 or motor_id < 1:
                print('Invalid id for 3508: acceptable range: 1-8, receive: %d' % motor_id)
                break
            if motor_id <= 4:
                tx_id = motor_id - 1
                if x200_list[tx_id] == '':
                    x200_list[tx_id] = motor_name
                else:
                    print('tx id conflict: %s, %s' % (motor_name, x200_list[tx_id]))
                    break
            else:
                tx_id = motor_id - 5
                if x1FF_list[tx_id] == '':
                    x1FF_list[tx_id] = motor_name
                else:
                    print('tx id conflict: %s, %s' % (motor_name, x1FF_list[tx_id]))
                    break

            rx_id = 200 + motor_id

        elif motor_type == '3510':
            if motor_id > 3 or motor_id < 1:
                print('Invalid id for 3510: acceptable range: 1-3, receive: %d' % motor_id)
                break
            tx_id = motor_id - 1
            if x1FF_list[tx_id] == '':
                x1FF_list[tx_id] = motor_name
            else:
                print('tx id conflict: %s, %s' % (motor_name, x1FF_list[tx_id]))
                break

            rx_id = 204 + motor_id

        elif motor_type == '6020':
            if motor_id > 7 or motor_id < 1:
                print('Invalid id for 6020: acceptable range: 1-7, receive: %d' % motor_id)
                break
            if motor_id <= 4:
                tx_id = motor_id - 1
                if x1FF_list[tx_id] == '':
                    x1FF_list[tx_id] = motor_name
                else:
                    print('tx id conflict: %s, %s' % (motor_name, x1FF_list[tx_id]))
                    break
            else:
                tx_id = motor_id - 5
                if x2FF_list[tx_id] == '':
                    x2FF_list[tx_id] = motor_name
                else:
                    print('tx id conflict: %s, %s' % (motor_name, x2FF_list[tx_id]))
                    break

            rx_id = 204 + motor_id

        else:
            print('motor type unrecognized: %s' % motor_type)

        if rx_id == 0:
            break

        if not motor_dict[rx_id]:
            motor_dict[rx_id] = motor_name
        else:
            print('rx id conflict: %s, %s, %d' % (motor_name, motor_dict[rx_id], rx_id))
            break
    print('0x200:')
    print(x200_list)
    print('0x1FF:')
    print(x1FF_list)
    print('0x2FF:')
    print(x2FF_list)
    print('rx:')
    print(motor_dict)