Motor und Lidar Steuerung

This commit is contained in:
Lukas Droste
2021-07-26 22:40:34 +02:00
parent 546fbbf6ff
commit ee4d7aa5bb
4 changed files with 483 additions and 0 deletions

View File

@@ -0,0 +1,43 @@
# Importing Libraries
import serial
import time
arduino = serial.Serial(port='COM5', baudrate=9600)
print("Start ...")
time.sleep(2)
print("Ready:")
def write_read(x):
arduino.write(bytes(x, 'utf-8'))
data = arduino.readline()
return filterY(str(data))
def setY(y):
print(write_read("<set><"+str(y)+">"))
def getY():
print(write_read("<get>"))
def resetY():
print(write_read("<reset>"))
def zerotY():
print(write_read("<zero>"))
def filterY(data):
temp = data[data.find("<"):data.find(">")]
return temp + data[data.find("><"):data.find(">", data.find("><")+2)+1]
def startScan(mode):
print("Scan gestartet")
def stopScan():
print("Scan gestoppt")
def getScanStatus():
return "%"
while True:
for x in range(11):
setY(x*36)