pwmRight = maxSpeed - abs(power)
            pwmLeft = maxSpeed + abs(power)
        else:
            pwmRight = maxSpeed + power
            pwmLeft = maxSpeed - power

        pwmRight = pwmRight + 3

        if (pwmRight > 100):
            pwmRight = 100
        elif (pwmRight < -100):
            pwmRight = -100
        if (pwmLeft > 100):
            pwmLeft = 100
        elif (pwmLeft < -100):
            pwmLeft = -100

        print str(pwmLeft) + "\t" + str(pwmRight) + "\t" + str(
            power) + "\t" + str(lost)

        motor.setLeftMotorSpeed(pwmLeft)
        motor.setRightMotorSpeed(pwmRight)

        motor.move()

finally:
    print "Goodbye :)"
    motor.clear()
    #os.system('sudo halt')
    time.sleep(0.05)
Ejemplo n.º 2
0
 def terminate(self):
     motor.clear()
     self._running = False