# Test code for stoplight
import time
import LCD

def Display(Light, x, y):
    Red = LCD.RGB(200,0,0)
    Yellow = LCD.RGB(200,200,0)
    Green = LCD.RGB(0,200,0)
    Brown = LCD.RGB(30,30,0)
    Black = 0
    White = LCD.RGB(200,200,200)
    
    LCD.Solid_Box(x, y, x+50, y+150, Brown)
    LCD.Box(x, y, x+50, y+150, White)
    
    y += 10
    x += 10
    if(Light == 0):
        LCD.Solid_Box(x,y,x+30,y+30,Red)
    else:
        LCD.Solid_Box(x,y,x+30,y+30,Black)
    LCD.Box(x,y,x+30,y+30,White)
    
    y += 50
    if(Light == 1):
        LCD.Solid_Box(x,y,x+30,y+30,Yellow)
    else:
        LCD.Solid_Box(x,y,x+30,y+30,Black)
    LCD.Box(x,y,x+30,y+30,White)
    
    y += 50
    if(Light == 2):
        LCD.Solid_Box(x,y,x+30,y+30,Green)
    else:
        LCD.Solid_Box(x,y,x+30,y+30,Black)
    LCD.Box(x,y,x+30,y+30,White)

Navy = LCD.RGB(0,0,5)
White = LCD.RGB(200,200,200)
LCD_Init()
LCD_Clear(Navy)
LCD.Text2('Stoplight',200,20,White,Navy)

# Main Routine: Cycle lights every 1.00 second
Red = 0
Yellow = 1
Green = 2
while (1):
    N = (N + 1) % 6
    if(N == 0):
        Display(Green, 100, 100)
        Display(Red, 200, 100)
    if(N==1):
        Display(Yellow, 100, 100)
        Display(Red, 200, 100)
    if(N==2):
        Display(Red, 100, 100)
        Display(Red, 200, 100)
    if(N==3):
        Display(Red, 100, 100)
        Display(Green, 200, 100)
    if(N==4):
        Display(Red, 100, 100)
        Display(Yellow, 200, 100)
    if(N==5):
        Display(Red, 100, 100)
        Display(Red, 200, 100)
    print(N)
    time.sleep(1)