main.py.bak

# SPDX-FileCopyrightText: 2018 Kattni Rembor for Adafruit Industries
#
# SPDX-License-Identifier: MIT
from digitalio import DigitalInOut, Direction, Pull

"""CircuitPython Essentials NeoPixel example"""
import time
import board
from rainbowio import colorwheel
import neopixel

pixel_pin = board.D5
num_pixels = 20

pixels = neopixel.NeoPixel(pixel_pin, num_pixels, brightness=0.3, auto_write=False)

ALLIANCE_LEDS = 5

print('Starting!')


###### knight Rider ######
'''while True:
    for forwards in range(20):
        pixels[forwards]=(255, 0, 0)
        pixels[forwards-1]=(75, 0, 0)
        pixels[forwards-2]=(0, 0, 0)
        #pixels[forwards+1]=(75, 0, 0)
        #pixels[forwards+2]=(0, 0, 0)
        if forwards == 18:
            pixels[forwards]=(255, 0, 0)
        if forwards == 19:
            pixels[forwards]=(75, 0, 0)
        pixels.show()
        time.sleep(1)
    for backwards in range(19, 0, -1):
        pixels[backwards]=(0, 0, 0)
        pixels[backwards-1]=(255, 0, 0)
        pixels.show()
        time.sleep(0.09)'''

##### Rainbow Circle ######
'''for rainbow in range(20):
    pixels[rainbow]=colorwheel(255/20*rainbow)
    pixels.show()

movingRainbow = 0
while True:
    for r in range(20):
        pixels[r]=colorwheel((255/20*(r+movingRainbow))%255)  
        #pixels[r]=colorwheel((r+movingRainbow)/20)
        pixels.show()
    movingRainbow = movingRainbow+1'''


##### FUNCTIONS FOR ROBOT #######

#pin7
pin7 = DigitalInOut(board.D7)
pin7.direction = Direction.INPUT
pin7.pull = Pull.DOWN

#pin9
pin9 = DigitalInOut(board.D9)
pin9.direction = Direction.INPUT
pin9.pull = Pull.DOWN

#pin10
pin10 = DigitalInOut(board.D10)
pin10.direction = Direction.INPUT
pin10.pull = Pull.DOWN

#pin11
pin11 = DigitalInOut(board.D11)
pin11.direction = Direction.INPUT
pin11.pull = Pull.DOWN

#pin12
pin12 = DigitalInOut(board.D12)
pin12.direction = Direction.INPUT
pin12.pull = Pull.DOWN

#pin13
pin13 = DigitalInOut(board.D13)
pin13.direction = Direction.INPUT
pin13.pull = Pull.DOWN

pin_alliance = pin7

allianceColor=(0, 0, 255)

def blinkingCube():
    for cube in range(15, 20, 1):
        pixels[cube]=(255, 0, 0)
    for cube in range(0, 15):
        pixels[cube]=(145, 0, 255)
    pixels.show()
    time.sleep(0.3)
    for cube in range(15):
        pixels[cube]=(0, 0, 0)
    pixels.show()
    time.sleep(0.2)
    
#while True:
   # blinkingCube()



def blinkingCone():
    for cube in range(15, 20, 1):
        pixels[cube]=(255, 0, 0)
    for cone in range(0, 15):
        pixels[cone]=(255, 165, 0)
    pixels.show()
    time.sleep(0.3)
    for cone in range(15):
        pixels[cone]=(0, 0, 0)
    pixels.show()
    time.sleep(0.2)

#while True:
    #blinkingCone()


def enable():
    def setAll(r, g, b):
        for a in range(20):
            pixels[a]=(r, g, b)
        pixels.show()

        for enable in range(20):
            pixels[enable]=(255, 0, 0)

        for t in range(256):
            setAll(0, t, 0)
        for t in range(255, -1, -1):
            setAll(0, t, 0)
#while True:
    #enable()


count=0 
def enabled(isCone):
    current_mode = read_current_mode()
    #print('start of loop 1')
    if isCone:
        color = (255, 165, 0)
    else:
        color = (145, 0, 255)
    for i in range(15, 20, 1):
        pixels[i]=color

    steps=30
    wait=0.04
    for countdown in range(steps, 1, -1):
        if read_current_mode() != current_mode:
            return
        for enabled in range(0, 15):
            pixels[enabled]=(0, 255*countdown/steps, 0)
        pixels.show()
        time.sleep(wait)
        #print('brightness down')

    for countup in range(1, steps, 1):
        if read_current_mode() != current_mode:
            return
        #print('in loop 1')
        for enabled in range(0, 15):
            pixels[enabled]=(0, 255*countup/steps, 0)
        pixels.show()
        time.sleep(wait)
        #print('brightness up')

#while True:
 #   enabled()


def no_code():
    #while True:
    for noCode in range(20):
        pixels[noCode]=(255, 0, 0)
    pixels.show()
    time.sleep(0.3)
    for noCode in range(20):
        pixels[noCode]=(0, 0, 0)
    pixels.show()
    time.sleep(0.3)
#while True:
    #noCode()

def disabled():
    current_mode = read_current_mode()

    steps=30
    wait=0.04
    for countdown in range(steps, 1, -1):
        if read_current_mode() != current_mode:
            return
        for enabled in range(0, 20):
            pixels[enabled]=(255*countdown/steps, 0, 0)
        pixels.show()
        time.sleep(wait)
        #print('brightness down')

    for countup in range(1, steps, 1):
        if read_current_mode() != current_mode:
            return
        #print('in loop 1')
        for enabled in range(0, 20):
            pixels[enabled]=(255*countup/steps, 0, 0)
        pixels.show()
        time.sleep(wait)
        #print('brightness up')

#new
"""
temp = pin13.value
temp2 = pin12.value<<1
temp3 = pin11.value<<2
temp4 = pin10.value<<3
temp5 = pin9.value<<4

temp_total = (temp+temp2+temp3+temp4+temp5)
print(temp_total)

#pin7value
print(pin7.value)

#pin9value
print(pin9.value)

#pin10value
print(pin10.value)

#pin11value
print(pin11.value)

#pin12value
print(pin12.value)

#pin13value
print(pin13.value)

time.sleep(5)
"""

"""
        RobotNotBooted(0),
        RobotDisabled(1),
        ConeMode(2),
        CubeMode(3),
        ConeCollected(4),
        CubeCollected(5);
"""
NO_CODE = 1 + 2 + 4 + 8 + 16
DISABLED = 1
CONE_MODE = 2
CUBE_MODE = 3
CONE_COLLECTED = 4
CUBE_COLLECTED = 5

def read_current_mode():
    temp = int(pin9.value)
    temp1 = (pin10.value)<<1
    temp2 = (pin11.value)<<2
    temp3 = (pin12.value)<<3
    temp4 = (pin13.value)<<4

    temp_total = (temp+temp1+temp2+temp3+temp4)
    
    # print(temp, temp1, temp2, temp3, temp4)
    # print('temp_total: ', temp_total)

    return temp_total

while True:

    # Read from pins

    if pin_alliance.value:
        allianceColor = (0, 0, 255)
    else:
        allianceColor = (255, 0, 0)

    mode = read_current_mode()

    if mode == NO_CODE:
        no_code()
    elif mode == DISABLED:
        disabled()
    elif mode == CONE_MODE:
        enabled(True)
    elif mode == CUBE_MODE:
        enabled(False)
    elif mode == CONE_COLLECTED:
        no_code()
    elif mode == CUBE_COLLECTED:
        no_code()
    else:
        disabled()

    time.sleep(0.01)

    # print('starting blinkingCube')
    # blinkingCube()
    # time.sleep(1)
    # print('ending blinkingCube')

    '''print('starting blinkingCone')
    blinkingCone()
    time.sleep(1)
    print('ending blinkingCone')

    print('starting enabled')
    enabled()
    time.sleep(1)
    print('ending enabled')

    print('starting noCode')
    noCode()
    time.sleep(1)
    print('ending noCode')

    print('starting disabled')
    disabled()
    time.sleep(1)
    print('ending disabled')'''



####### EXTRAS ########

'''def lowBattery():
    for lowBattery in range(20):
        pixels[lowBattery]=(0, 255, 0)
    pixels.show()
    time.sleep(5/count)
    for lowBattery in range(20):
        pixels[lowBattery]=(240, 70, 0)
    pixels.show()
    time.sleep(1)

    if count < 4:
        for lowBattery in range(20):
            pixels[lowBattery]=(0, 255, 0)
        pixels.show()
        time.sleep(5/count)
        for lowBattery in range(20):
            pixels[lowBattery]=(240, 70, 0)
        pixels.show()
        time.sleep(1)

    elif count >= 4 and count >= 8:
        for lowBattery in range(20):
            pixels[lowBattery]=(240, 70, 0)
        pixels.show()
        time.sleep(5/(count-3))
        for lowBattery in range(20):
            pixels[lowBattery]=(255, 0, 0)
        pixels.show()
        time.sleep(1)

    else:
        pixels[lowBattery]=(255, 0, 0)'''