146 lines
4.8 KiB
Python
146 lines
4.8 KiB
Python
|
# LEGO type:standard slot:5 autostart
|
||
|
|
|
||
|
|
import os, sys
|
||
|
|
|
||
|
|
from spike import PrimeHub, LightMatrix, Button, StatusLight, ForceSensor, MotionSensor, Speaker, ColorSensor, App, DistanceSensor, Motor, MotorPair
|
||
|
|
from spike.control import wait_for_seconds, wait_until, Timer
|
||
|
|
from hub import battery
|
||
|
|
from math import *
|
||
|
|
|
||
|
|
############## Allgemein: Prüfe Batteriezustand ###############################
|
||
|
|
if battery.voltage() < 8000: #set threshold for battery level
|
||
|
|
print("Spannung der Batterie zu niedrig: " + str(battery.voltage()) + " \n"
|
||
|
|
+ "--------------------------------------- \n "
|
||
|
|
+ "#### UNBEDINGT ROBOTER AUFLADEN !!! #### \n"
|
||
|
|
+ "---------------------------------------- \n")
|
||
|
|
else:
|
||
|
|
print("Spannung der Batterie " + str(battery.voltage()) + "\n")
|
||
|
|
################################################################################
|
||
|
|
|
||
|
|
############################## NICHT ÄNDERN ###############################
|
||
|
|
def importFile(slotid=0, precompiled=False, module_name='importFile'):
|
||
|
|
print("##### START # IMPORTING CODE FROM SLOT "+str(slotid)+" ##############")
|
||
|
|
import os, sys
|
||
|
|
suffix = ".py"
|
||
|
|
if precompiled:
|
||
|
|
suffix = ".mpy"
|
||
|
|
with open("/projects/.slots","rt") as f:
|
||
|
|
slots = eval(str(f.read()))
|
||
|
|
print(slots)
|
||
|
|
#print(os.listdir("/projects/"+str(slots[slotid]["id"])))
|
||
|
|
with open("/projects/"+str(slots[slotid]["id"])+"/__init__"+suffix,"rb") as f:
|
||
|
|
print("trying to read import program")
|
||
|
|
program = f.read()
|
||
|
|
#print(program)
|
||
|
|
try:
|
||
|
|
os.remove("/"+module_name+suffix)
|
||
|
|
except:
|
||
|
|
pass
|
||
|
|
with open("/"+module_name+suffix,"w+") as f:
|
||
|
|
print("trying to write import program")
|
||
|
|
f.write(program)
|
||
|
|
if (module_name in sys.modules):
|
||
|
|
del sys.modules[module_name]
|
||
|
|
#exec("from " + module_name + " import *")
|
||
|
|
print("##### END # IMPORTING CODE FROM SLOT "+str(slotid)+" ##############")
|
||
|
|
#####################################################################################
|
||
|
|
|
||
|
|
|
||
|
|
################ Importiere Code aus andere Dateien #################################
|
||
|
|
|
||
|
|
# Importiere Code aus der Datei "iqrobot.py"
|
||
|
|
# Dateiname und Modulname sollten gleich sein, dann kann man Code Completion nutzen
|
||
|
|
importFile(slotid=6, precompiled=True, module_name="iqrobot")
|
||
|
|
import iqrobot as iq
|
||
|
|
|
||
|
|
################### Hauptcode ####################################
|
||
|
|
'''
|
||
|
|
Code zum Lösen einer Aufgabe, kann oben importierten Code nutzen
|
||
|
|
Es können auch pro Aufgabe eigene Funktionen geschrieben werden
|
||
|
|
Wichtig ist, dass die PORTS der Sensoren überall gleich sind
|
||
|
|
und auch `hub` als Instanz von PrimeHub
|
||
|
|
dh auch an die Funktionen im importierten Code übergeben werde
|
||
|
|
'''
|
||
|
|
|
||
|
|
# Initialisieren des Hubs, der Aktoren und Sensoren
|
||
|
|
hub = PrimeHub()
|
||
|
|
|
||
|
|
# Initialisiere Robot Klasse mit unseren Funktionen
|
||
|
|
iqRobot: iq.IQRobot = iq.IQRobot(hub)
|
||
|
|
|
||
|
|
# Führe Funktionen aus unser Robot Klasse aus:
|
||
|
|
iqRobot.show('HAPPY')
|
||
|
|
|
||
|
|
def huenchenaufgabe():
|
||
|
|
iqRobot.fahre_gerade_aus(40,60)
|
||
|
|
iqRobot.drehe(-40,True)
|
||
|
|
iqRobot.fahre_gerade_aus(20,60)
|
||
|
|
iqRobot.drehe(-20)
|
||
|
|
iqRobot.fahre_gerade_aus(55,60)
|
||
|
|
iqRobot.heber(10,30)
|
||
|
|
|
||
|
|
def hologram_alt():
|
||
|
|
iqRobot.fahre_gerade_aus(cm=75,speed=80)
|
||
|
|
iqRobot.drehe(45, False)
|
||
|
|
iqRobot.fahre_gerade_aus(cm=14,speed=70)
|
||
|
|
iqRobot.fahre_gerade_aus(cm=-13,speed=50)
|
||
|
|
iqRobot.drehe(-45, False)
|
||
|
|
iqRobot.fahre_gerade_aus(cm=-75,speed=50)
|
||
|
|
|
||
|
|
def druckmaschine():
|
||
|
|
iqRobot.fahre_gerade_aus(19,70)
|
||
|
|
iqRobot.drehe(-45)
|
||
|
|
iqRobot.fahre_gerade_aus(25,50)
|
||
|
|
iqRobot.fahre_gerade_aus(-15,40)
|
||
|
|
|
||
|
|
def hologram():
|
||
|
|
iqRobot.drehe(45)
|
||
|
|
iqRobot.fahre_gerade_aus(37.5,30)
|
||
|
|
iqRobot.fahre_bis_abstand(28,30,True)
|
||
|
|
print(iqRobot.abstandsSensor.get_distance_cm())
|
||
|
|
iqRobot.drehe(45)
|
||
|
|
iqRobot.antrieb.move_tank(15,left_speed=30,right_speed=30)
|
||
|
|
#iqRobot.fahre_gerade_aus(15,30)
|
||
|
|
iqRobot.fahre_gerade_aus(-15,30)
|
||
|
|
|
||
|
|
def augmented_reality():
|
||
|
|
iqRobot.drehe(-135)
|
||
|
|
iqRobot.fahre_gerade_aus(40,30)
|
||
|
|
iqRobot.drehe(90)
|
||
|
|
iqRobot.fahre_gerade_aus(12,30)
|
||
|
|
iqRobot.schaufel(-2200)
|
||
|
|
iqRobot.fahre_gerade_aus(-4,30)
|
||
|
|
iqRobot.drehe(90)
|
||
|
|
iqRobot.fahre_gerade_aus(20,30)
|
||
|
|
#iqRobot.drehe(-90)
|
||
|
|
#iqRobot.fahre_gerade_aus(5,20)
|
||
|
|
|
||
|
|
def backHome():
|
||
|
|
iqRobot.fahre_gerade_aus(-5, 30)
|
||
|
|
iqRobot.drehe(138)
|
||
|
|
iqRobot.fahre_gerade_aus_alt(80, 100)
|
||
|
|
|
||
|
|
|
||
|
|
#iqRobot.fahre_gerade_aus(16, 20)
|
||
|
|
#iqRobot.drehe(38)
|
||
|
|
#iqRobot.fahre_gerade_aus(33,25)
|
||
|
|
#iqRobot.schaufel(1600, speed=100 )
|
||
|
|
#iqRobot.schaufel(-1600, speed=100 )
|
||
|
|
|
||
|
|
# druckmaschine()
|
||
|
|
# hologram()
|
||
|
|
# augmented_reality()
|
||
|
|
#backHome()
|
||
|
|
#huenchenaufgabe()
|
||
|
|
|
||
|
|
#iqRobot.farbSensor.light_up(1,1,1)
|
||
|
|
|
||
|
|
#wait_for_seconds(2)
|
||
|
|
|
||
|
|
while 0 == 0:
|
||
|
|
#print(iqRobot.abstandsSensor.get_distance_cm())
|
||
|
|
#print(iqRobot.farbSensor.get_reflected_light())
|
||
|
|
print(str(iqRobot.farbSensor.get_blue())+" "+str(iqRobot.farbSensor.get_green())+" "+str(iqRobot.farbSensor.get_red()))
|
||
|
|
wait_for_seconds(0.5)
|
||
|
|
|