from Encoder import * import Kompass from Karte import * from Plan import * from Motor import * from Grid import * import sys import atexit count = 1 speed = 0 steer = 0 encoder = Encoder() navigation = Navigation() scanner = Scanner() karte = Karte(encoder) plan = Plan() kreis = 0 motor = Motor() grid = Grid(50, 50) grid.setZielInGrid(15, 49) grid.setStartInGrid(15, 1) karte.setRoboPosZero(150, 150) def cleaning(): """Do cleanup at end, command are visVersa""" motor.setCommand(0, 0)
from Karte import * from Motion import * from Weggeber import * from SMBUSBatt import * from Pathplaning import * from Scanner import * from math import * import pickle from Avoid import * from Transmit import * from Planer import * manuell = Manuell() motion = Motion() battery = SMBUSBatt() karte = Karte() weggeber = Weggeber() pathplaning = Pathplaning() scanner = Scanner() avoid = Avoid() transmit = Transmit() pumper = Pumper() planer = Planer(avoid, karte) ThreadEncoder = Thread(target=manuell.runManuell, args=()) ThreadEncoder.daemon = True ThreadEncoder.start() theta_goal = 180 x_goal = 0 y_goal = 70