janishutz-legacy/micro_bit_interface
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

FollowTheLine

Browse Source
This commit is contained in:
janis
2022-06-27 15:07:47 +02:00
parent 3b5e6be980
commit e25bac778e
5 changed files with 53 additions and 23 deletions
Download Patch File Download Diff File Expand all files Collapse all files

47
bin/micro_bit/micro_bit_soft/follow_the_line/ftl.py
View File

@@ -1,29 +1,40 @@
import maqueen_driver
import microbit
import music
md = maqueen_driver.Driver()
class FollowTheLine:
def __init__(self):
self.__activated = 0
self.__repeated = 0
def run(self):
while True:
if md.getDistance() < 20:
md.stop()
md.setLEDs(on=1)
music.pitch(440, 20)
else:
if md.getLineTracker(1) == 0:
self.__activated = 0
md.motor(0, 100, 0, 255)
elif md.getLineTracker(2) == 0:
self.__activated = 0
md.motor(0, 255, 0, 100)
if md.getLineTracker(1) == 0:
self.__activated = 0
if self.__repeated >= 75 and self.__repeated < 150:
self.__repeated += 1
md.motor(0, 10, 0, 100)
elif self.__repeated >= 100:
md.motor(0, 0, 0, 100)
else:
if self.__activated <= 50:
self.__activated += 1
md.motor(0, 140, 0, 140)
else:
md.motor(0, 255, 0, 255)
self.__repeated += 1
md.motor(0, 50, 0, 100)
elif md.getLineTracker(2) == 0:
self.__activated = 0
self.__repeated += 1
if self.__repeated >= 75 and self.__repeated < 150:
self.__repeated += 1
md.motor(0, 100, 0, 10)
elif self.__repeated >= 100:
md.motor(0, 100, 0, 0)
else:
self.__repeated += 1
md.motor(0, 100, 0, 50)
else:
self.__repeated = 0
if self.__activated <= 2000:
self.__activated += 1
md.motor(0, 100, 0, 100)
else:
md.motor(0, 255, 0, 255)

17
bin/micro_bit/micro_bit_soft/follow_the_line/ftl_dumb_version.py Normal file
View File

@@ -0,0 +1,17 @@
import maqueen_driver
md = maqueen_driver.Driver()
class FollowTheLineDumnb:
def __init__(self):
pass
def run(self):
while True:
if md.getLineTracker(1) == 1:
md.motor(0, 10, 0, 75)
elif md.getLineTracker(2) == 2:
md.motor(0, 75, 0, 10)
else:
md.motor(0, 75, 0, 75)

4
bin/micro_bit/micro_bit_soft/follow_the_line/run.py
View File

@@ -1,3 +1,3 @@
import ftl
import ftl_dumb_version
ftl.FollowTheLine().run()
ftl_dumb_version.FollowTheLineDumnb().run()