-
Notifications
You must be signed in to change notification settings - Fork 0
/
get_imu_data.py
33 lines (21 loc) · 915 Bytes
/
get_imu_data.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
# imudan yaw, pitch , roll açılarını terminalde yazdırma
import serial
port = serial.Serial('com6',115200)
port.reset_input_buffer()
while(True):
while (port.inWaiting()==0): #Veri olmadığı sürece bu burada dönecek
pass
try:
packet = port.readline()
str_packet = str(packet,'utf-8')
except:
continue # UnicodeDecodeError: 'utf-8' codec can't decode byte 0xfd in position 0: invalid start byte ( Bu hatayı önlemek için)
virgule = ','
if virgule in str_packet: # veri paketi virgüllü geldiği için başta ki kalibrasyon çıktısı hata vermemesi için yaptık.
split_packet = str_packet.split(',')
x = float(split_packet[0])
y = float(split_packet[1])
z = float(split_packet[2][0:4])
print(f"x: {x} y : {y} z : {z}")
else:
print(str_packet)