Skip to content

Commit 206ee05

Browse files
Code cleaning and improvement
1 parent 04bdea7 commit 206ee05

2 files changed

Lines changed: 27 additions & 63 deletions

File tree

Server/Controller_Serial/Controller_Serial.ino

Lines changed: 3 additions & 3 deletions
Original file line numberDiff line numberDiff line change
@@ -17,7 +17,7 @@ int JoysticRanges[] = {3200,10,3200,100}; // You can check these values j
1717
LG_JoysticSetup joystic(A6,A7,4,JoysticRanges);
1818
LG_UltrasonicSetup Ultrasonic(21,19);
1919

20-
String Commands[]={"0","linear","zOut","zIn","right","left","up","down","rightUp","rightDown","leftUp","leftDown",
20+
String Commands[]={"zero","linear","zOut","zIn","right","left","up","down","rightUp","rightDown","leftUp","leftDown",
2121
"CamUp","CamDown","CamRight","CamLeft","rollRight","rollLeft","tiltUp","tiltDown"};
2222

2323
String Coordnates[16][3]={
@@ -51,8 +51,8 @@ void loop()
5151
moviment =1;
5252
JoysticAnalyser(3,joy);
5353
} else if(moviment==1)
54-
{
55-
Serial.println(0);
54+
{ LGMove(0);
55+
//Serial.println(0);
5656
moviment=0;
5757
}
5858

Server/SerialServer.py

Lines changed: 24 additions & 60 deletions
Original file line numberDiff line numberDiff line change
@@ -1,110 +1,74 @@
1+
#!/usr/bin/python
12
import serial
3+
import keyboard
24

35
from pynput.keyboard import Key, Controller as KeyboardController
46

57
keyb = KeyboardController()
68

79
comport = serial.Serial('/dev/ttyUSB0', 9600)
8-
9-
1010
#comport = serial.Serial('COM3', 9600)
1111

1212
def Position_Controller(dataRec):
1313
data = dataRec
14-
1514
print(data)
1615

1716
if "linear" in data:
1817
keyb.press('r')
19-
else:
20-
keyb.release('r')
21-
if "zOut" in data:
22-
keyb.press(Key.page_up)
23-
else:
24-
keyb.release(Key.page_up)
25-
if "zIn" in data:
18+
elif "zOut" in data:
2619
keyb.press(Key.page_down)
27-
else:
28-
keyb.release(Key.page_down)
29-
if "right" in data:
20+
elif "zIn" in data:
21+
keyb.press(Key.page_up)
22+
elif "right" in data:
3023
keyb.press(Key.right) # RIGHT
31-
else:
32-
keyb.release(Key.right)
33-
if "left" in data:
24+
elif "left" in data:
3425
keyb.press(Key.left) # LEFT
35-
else:
36-
keyb.release(Key.left)
37-
if "up" in data:
26+
elif "up" in data:
3827
keyb.press(Key.up) # UP
39-
else:
40-
keyb.release(Key.up)
41-
if "down" in data:
28+
elif "down" in data:
4229
keyb.press(Key.down) # DOWN
43-
else:
44-
keyb.release(Key.down)
45-
if "CamUp" in data:
30+
elif "CamUp" in data:
4631
keyb.press(Key.ctrl)
4732
keyb.press(Key.up)
48-
else:
49-
keyb.release(Key.ctrl)
50-
keyb.release(Key.up)
51-
if "CamDown" in data:
33+
elif "CamDown" in data:
5234
keyb.press(Key.ctrl)
5335
keyb.press(Key.down)
54-
else:
55-
keyb.release(Key.ctrl)
56-
keyb.release(Key.down)
57-
if "CamRight" in data:
36+
elif "CamRight" in data:
5837
keyb.press(Key.ctrl)
5938
keyb.press(Key.right)
60-
else:
61-
keyb.release(Key.ctrl)
62-
keyb.release(Key.right)
63-
if "CamLeft" in data:
39+
elif "CamLeft" in data:
6440
keyb.press(Key.ctrl)
6541
keyb.press(Key.left)
66-
else:
67-
keyb.release(Key.ctrl)
68-
keyb.release(Key.left)
69-
if "rollRight" in data:
42+
elif "rollRight" in data:
7043
keyb.press(Key.shift)
7144
keyb.press(Key.right)
72-
else:
73-
keyb.release(Key.shift)
74-
keyb.release(Key.right)
75-
if "rollLeft" in data:
45+
elif "rollLeft" in data:
7646
keyb.press(Key.shift)
7747
keyb.press(Key.left)
78-
else:
79-
keyb.release(Key.shift)
80-
keyb.release(Key.left)
81-
if "tiltUp" in data:
48+
elif "tiltUp" in data:
8249
keyb.press(Key.shift)
8350
keyb.press(Key.up) # UP Tilt
84-
else:
85-
keyb.release(Key.shift)
86-
keyb.release(Key.up)
87-
if "tiltDown" in data:
51+
elif "tiltDown" in data:
8852
keyb.press(Key.shift)
8953
keyb.press(Key.down) # DOWN Tilt
90-
else:
54+
elif "zero" in data:
9155
keyb.release(Key.shift)
56+
keyb.release(Key.ctrl)
9257
keyb.release(Key.down)
93-
58+
keyb.release(Key.right)
59+
keyb.release(Key.left)
60+
keyb.release(Key.up)
61+
else:
9462
f = open("/tmp/query.txt", "w")
9563
f.write(data)
9664
f.close()
9765

98-
data = 0
99-
10066

10167
if __name__ == "__main__":
10268

10369
while True:
10470
valor = comport.readline().decode('UTF-8')
105-
106-
print(valor)
107-
10871
Position_Controller(valor)
10972

11073
# comport.close()
74+

0 commit comments

Comments
 (0)