raven2_XBOX_Python_controller/utils_r2_keyboard_controller.py at main · MHC-RobotSimulators-Research/raven2_XBOX_Python_controller · 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
# -*- coding: utf-8 -*-
"""
Created on Mon Dec  6 18:22:45 2021

@author: 75678
"""
import sys

def print_manu():
    print('  ')
    print('-----------------------------------------')
    print('RAVEN 2 Keyboard Controller:')
    print('-----------------------------------------')
    print('[Exit]: 9')
    print('[Joint 1 +]: 1 | [Joint 1 -]: q')
    print('[Joint 2 +]: 2 | [Joint 2 -]: w')
    print('[Joint 3 +]: 3 | [Joint 3 -]: e')
    print('[Joint 4 +]: 4 | [Joint 4 -]: r')
    print('[Joint 5 +]: 5 | [Joint 5 -]: t')
    print('[Joint 6 +]: 6 | [Joint 6 -]: y')
    print('[Joint 7 +]: 7 | [Joint 7 -]: u')

    print('[Grasper open ]: o')
    print('[Grasper close ]: p')

    print('[Grasper farward ]: s')
    print('[Grasper backward]: x')
    print('[Grasper left    ]: z')
    print('[Grasper right   ]: c')
    print('[Grasper up      ]: f')
    print('[Grasper down    ]: v')

    print('[Grasper P -]: h')
    print('[Grasper P +]: n')
    print('[Grasper R -]: b')
    print('[Grasper R +]: m')
    print('[Grasper Y -]: g')
    print('[Grasper Y +]: j')

    print('-----------------------------------------')
    print('-----------------------------------------')
    print('Current command:')
    return None

def print_no_newline(string):
    # sys.stdout.write("\r" + '                               ')
    sys.stdout.write("\r" + string)
    sys.stdout.flush()
    return None