-
Notifications
You must be signed in to change notification settings - Fork 0
/
servRFCOM2.py
98 lines (67 loc) · 2.22 KB
/
servRFCOM2.py
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
import RPi.GPIO as GPIO
import time
from bluetooth import *
#####fonctions
def angleTOpercent (angle) :
if angle > 180 or angle < 0 :
return False
start = 4
end = 12.5
ratio = (end - start)/180
angle_as_percent = angle * ratio
return start + angle_as_percent
#####
GPIO.setwarnings(False)
LED_PIN = 17
pinMoteur = 24
frequence = 50
GPIO.setmode(GPIO.BCM)
GPIO.setup(LED_PIN, GPIO.OUT)
GPIO.setup(pinMoteur, GPIO.OUT)
pwm = GPIO.PWM(pinMoteur, frequence)
server_sock=BluetoothSocket( RFCOMM )
server_sock.bind(("",PORT_ANY))
server_sock.listen(1)
port = server_sock.getsockname()[1]
uuid = "94f39d29-7d6d-437d-973b-fba39e49d4ee"
advertise_service( server_sock, "SampleServer",
service_id = uuid,
service_classes = [ uuid, SERIAL_PORT_CLASS ],
profiles = [ SERIAL_PORT_PROFILE ],
)
try:
while True:
print("Waiting for connection on RFCOMM channel %d" % port)
client_sock, client_info = server_sock.accept()
print("Accepted connection from ", client_info)
try:
while True:
data = client_sock.recv(1024)
if len(data) == 0: break
print("received [%s]" % data)
if data == 'led1':
GPIO.output(LED_PIN,True)
data ='led on'
elif data == 'led0':
GPIO.output(LED_PIN,False)
data = 'led off'
elif 'moteur' in data:
angle = data.split(' ')
print(angle[1])
pwm.start(angleTOpercent(int(angle[1])))
time.sleep(1)
#pwm.stop()
elif data =='exit':
raise Exception('stop serveur')
else:
data = 'Commande inconnue !'
client_sock.send(data)
print ("sending [%s]" % data)
except IOError:
pass
print("disconnected")
client_sock.close()
except Exception:
print("Stop serveur Bluetooth !")
server_sock.close()
GPIO.cleanup()