def initSetup(self):
##init all modules
self.displayModul = display.display()
self.motorModul = motor.motor()
self.motorModul.start()
self.i2c = i2cHandler.I2cHandler()
self.i2c.start()
self.cameraModul = camera.camera(self.i2c)
self.cameraModul.start()
i = init.initActivity(self, self.i2c)
from time import sleep
from common import drivingUtilities
from modul import i2cHandler
from modul import motor
motorDriver = None
handler = None
testPattern = 1
try:
handler = i2cHandler.I2cHandler()
handler.start()
motorDriver = motor.motor()
motorDriver.start()
motorDriver.startLogging()
utilities = drivingUtilities.DrivingUtilities(handler, motorDriver)
# Simple drive forward, turn, forward, turn
if (testPattern == 1):
for x in range(0, 1):
sleep(0.5)
utilities.accelerate(60)
sleep(1)
utilities.accelerate(100)
utilities.stop()
utilities.turn(180)
utilities.accelerate(100)
sleep(1)
from modul import i2cHandler
from time import sleep
from modul import fork
import config
controller = None
i2c = None
try:
forkHandler = fork.fork()
i2c = i2cHandler.I2cHandler()
i2c.start()
moveButtonSlider = True
# print("Start init Buttonslider")
while moveButtonSlider:
# print("LeftFront: " + str(i2c.getDistanceLeftFront()))
# print("RightFront: " + str(i2c.getDistanceRightFront()))
if (i2c.getDistanceLeftFront() - i2c.getDistanceRightFront()):
if (i2c.getDistanceLeftFront() > i2c.getDistanceRightFront()):
forkHandler.moveLeft()
if (abs(i2c.getDistanceLeftFront() -
i2c.getDistanceRightFront()) < 5):
sleep(0.01)
forkHandler.stopMovement()
sleep(0.02)
print("shift left")
else:
forkHandler.moveRight()
if (abs(i2c.getDistanceLeftFront() -
