View source for Lego Interactive Brick Program

''
 //Demonstration Program for Interactive LCD Touch Screen Lego 70455 Interface  

 #include <tinyFAT.h>
 #include <UTFT.h>
 #include <UTFT_tinyFAT.h>
 #include <UTouch.h>
 #include <LegoTechnic.h>
 
 // Declare which fonts we will be using
 extern uint8_t SmallFont[];
 
 UTFT         LEGO_Display(ITDB32S, 38, 39, 40, 41);   // Remember to change the model parameter to suit your display module!
 UTFT_tinyFAT LEGO_Files(&LEGO_Display);
 UTouch       LEGO_Touch( 6, 5, 4, 3, 2);
 
 LegoTechnic brick(8, 9, 10, 11, 12, 13, 0, 1);
 
 int picsize_x, picsize_y; 
 
 word resource;
 
 // Display locations
 int x_HotSpot=85;
 int y_HotSpot=163;
 int HotSpot_width=202;
 int HotSpot_height=72; 
 
 int x_slider = 86;
 int y_slider = 173;
 int slider_space = 19;
 int slider_width = 10;
 int slider_height = 10;
   
 int x_indicator = 259;
 int y_indicator = 59;
 int indicator_space = 34;
 int indicator_width = 5;
 int indicator_height = 5;
   
 int x_button = 277;
 int y_button = 73;
 int button_width = 19;
 int button_height = 40; 
 
 int x_output = 86;
 int y_output = 140;
 int output_space = 107;
 int output_width = 200;
 int output_height = 10;

 void setup()
 {
 // Initialize LEGO brick 
   brick.Port_Initialize();
   
 // Prepare Display 
   LEGO_Display.InitLCD();
   LEGO_Display.clrScr();
   LEGO_Display.setColor(255,255,255);
   LEGO_Display.setFont(SmallFont);
   picsize_x=LEGO_Display.getDisplayXSize();
   picsize_y=LEGO_Display.getDisplayYSize();
   
 //  Prepare Touch Screen
  LEGO_Touch.InitTouch(); 
  LEGO_Touch.setPrecision (PREC_MEDIUM);
  LEGO_Display.setBackCol or(0, 0, 255);
   
 // LEGO Library has Serial Monitor Functions
   Serial.begin(9600);  
   
 //  Load Interface Image
  file.initFAT();
  resource=LEGO_Files.loadBitmap(0, 0, picsize_x, picsize_y, "LEGOPIC.RAW");   
 }

 void loop()
 {
   int hold_value[6]={0,0,0,0,0,0};
   int x,y;
   int Previous_I0, Present_I0;
   int Previous_I1, Present_I1;
   int button_value; 
    
 // Draw Screen Elements    
  Sliders();
  Outputs();
  brick.Verbose(LOW);
  UpdateDisplay();  
 
  Previous_I0 = -1;
  Previous_I1 = -1;  
 
  while (true)
  {
 
 // Check for change to input values
    Present_I0 = brick.Input_Port(6);
    Present_I1 = brick.Input_Port(7);
    if (Present_I0 != Previous_I0)
      {
        Previous_I0 = Present_I0;
        DrawIndicatorValue(6,Present_I0);
        DrawOutputValue(0,Present_I0);        
      }
    if (Present_I1 != Previous_I1)
      {
        Previous_I1 = Present_I1;
        DrawIndicatorValue(7,Present_I1);
        DrawOutputValue(1,Present_I1);        
      }
 
 // Test for touch screen input       
    if (LEGO_Touch.dataAvailable())
    {
      LEGO_Touch.read();
      x=LEGO_Touch.getX();
      y=LEGO_Touch.getY();
      EvaluateTouch(x,y);       
      delay(100);
      while(LEGO_Touch.dataAvailable()) 
      {
        LEGO_Touch.read();
      }
    }
  }
 
 }

 // Determine if touch screen input is within an active zone
 void EvaluateTouch(int x, int y)
 {
  if ((x >= x_HotSpot) && (x <= x_HotSpot + HotSpot_width))
    if ((y >= y_HotSpot) && (y <= y_HotSpot + HotSpot_height))
      EvaluateSliders(x,y);
      
  if ((x >= x_button) && (x <= x_button + button_width))
    if ((y >= y_button) && (y <= y_button + button_height))
      ExecuteButton(x,y);      
 }
   
 // Reset Button for Outputs
 void ExecuteButton(int x,int y)
 {
   for(int x=0; x< 6; ++x)
    {
      EraseSliderValue(x, int (brick.Port_PWM_Value(x)/25));
      brick.PWM_Port(x, 0);
    }
  UpdateDisplay();  
 }

 // Determine which slider was "touched"
 void EvaluateSliders(int x,int y)
 {
  int line_number = (5 - (y-y_HotSpot)/(slider_height+1));
  int line_value = (x-x_HotSpot)/(slider_space);
  
  EraseSliderValue(line_number, int (brick.Port_PWM_Value(line_number)/25));
  brick.PWM_Port(line_number, int (line_value * 25));
  DrawSliderValue(line_number, line_value);
  DrawIndicatorValue(line_number,brick.Port_PWM_Value(line_number));
 
 }

 // Update Screen Elements
 void UpdateDisplay()
 {
  for(int x=0;x<8;++x)
    {
      if (x < 6)
        {
          DrawSliderValue(x,brick.Port_PWM_Value(x)); 
          DrawIndicatorValue(x,brick.Port_PWM_Value(x));     
        }
       else
        DrawIndicatorValue(x,brick.Input_Port(x)); 
    }
 }

 // Draw All Sliders
 void Sliders()
 {
  for(int x=0; x < 6; ++x)
    {
      y_slider = 224-(x*(slider_height+2));
      DrawSlider(x);   
      DrawSliderValue(x,0); 
    } 
 } 

 // Draw each Slider
 void DrawSlider(int line)
 {
  String label=" Line ";
  label.concat(char(48+line));
  LEGO_Display.setColor(255,255,255);
  LEGO_Display.setBackColor(0,0,0);  
  LEGO_Display.print(label, LEFT,224-(line*(slider_height+2)));
  LEGO_Display.print(" OFF", 53, 224-(line*(slider_height+2)));
  LEGO_Display.print(" MAX", RIGHT, 224-(line*(slider_height+2)));
  LEGO_Display.setColor(0,0,0);
  LEGO_Display.drawLine(x_slider,224-(line*(slider_height+2))+(slider_height/2),x_slider+slider_width+(10*slider_space),224-(line*(slider_height+2))+(slider_height/2));
  for(int x=0;x<11;++x)
    {
      LEGO_Display.drawLine(x_slider+(slider_width/2)+(x*slider_space),224-(line*(slider_height+2)),x_slider+(slider_width/2)+(x*slider_space),224-(line*(slider_height+2))+(slider_height));      
    }
 }

 // Display Slider Value on Screen
 void DrawSliderValue(int line, int value)
 {
  if (line < 6)
    LEGO_Display.setColor(255, 0, 0);
   else
    LEGO_Display.setColor(0, 255, 0);
  if (value == 0)
   LEGO_Display.setColor(0,0,0);  
  LEGO_Display.fillRoundRect(x_slider+(value*slider_space), 224-(line*(slider_height+2)), x_slider+slider_width+(value*slider_space), 224-(line*(slider_height+2)) + slider_height);    
  LEGO_Display.setColor(0, 0, 0); 
  LEGO_Display.drawRoundRect (x_slider+(value*slider_space), 224-(line*(slider_height+2)), x_slider+slider_width+(value*slider_space), 224-(line*(slider_height+2)) + slider_height);
  if (value == 0)
    {
      LEGO_Display.setColor(255,255,255);   
      LEGO_Display.drawRoundRect (x_slider+(value*slider_space)+1, 224-(line*(slider_height+2))+1, x_slider+slider_width+(value*slider_space)-1, 224-(line*(slider_height+2)) + slider_height-1);      
    }
 } 

  // Remove Slider value from Screen
  void EraseSliderValue(int line, int value)
 {
  LEGO_Display.setColor(0, 255, 255);
  LEGO_Display.fillRoundRect(x_slider+(value*slider_space), 224-(line*(slider_height+2)), x_slider+slider_width+(value*slider_space), 224-(line*(slider_height+2)) + slider_height);    
  LEGO_Display.setColor(0,0,0);
  LEGO_Display.drawLine (x_slider+(value*slider_space), 224-(line*(slider_height+2))+(slider_height/2), x_slider+slider_width+(value*slider_space), 224-(line*(slider_height+2))+(slider_height/2));
  LEGO_Display.drawLine(x_slider+(slider_width/2)+(value*slider_space),224-(line*(slider_height+2)),x_slider+(slider_width/2)+(value*slider_space),224-(line*(slider_height+2))+(slider_height));        
 }

 // Draw Indicator Dots on Screen
 void Indicators()
 {
  for(int x=0; x < 8; ++x)
    {
      DrawIndicatorValue(x,0);   
    } 
 }

 // Display Input and Output Status on Screen
 void DrawIndicatorValue(int line, int value)
 {
  LEGO_Display.setColor(50,50,50);
  
  if (line < 6)
    {
    if (value != 0)
      LEGO_Display.setColor(255,0,0);     
    }  
   else
    {
      if (value > 511)
        LEGO_Display.setColor(0,255,0);   
      Serial.println(value);     
    }   
      
  LEGO_Display.fillRoundRect(x_indicator-(line*indicator_space), y_indicator, x_indicator-indicator_width-(line*indicator_space), y_indicator + indicator_height);         
  LEGO_Display.setColor(0,0,0);
  LEGO_Display.drawRoundRect(x_indicator-(line*indicator_space), y_indicator, x_indicator-indicator_width-(line*indicator_space), y_indicator + indicator_height);               
 }

 // Draw All Input Display on Screen
 void Outputs()
 {
   for(int x=0;x<2;++x)
    {
      DrawOutput(x);
      DrawOutputValue(x,LOW);  
    }
 }

 // Draw each Input Display on Screen
 void DrawOutput(int line)
 {
  String label=" Output ";
  label.concat(char(48-line+7));
  label.concat(" ");
  LEGO_Display.setColor(255,255,255);
  LEGO_Display.setBackColor(0,0,0);  
  LEGO_Display.print(label, LEFT,y_output+(line*(output_height+2)));
  LEGO_Display.print("    ", RIGHT, y_output+(line*(output_height+2)));
  LEGO_Display.setColor(0,0,0);
  
  LEGO_Display.drawRoundRect(x_output, y_output+(line*(output_height+2)), x_output+output_width, y_output+(line*(output_height+2)) + output_height);                 
 
 }

 // Draw Input Display based on Value to Screen
 void DrawOutputValue(int line, int value)
 {
  if (line == 0)
    line = 1;
   else
    line = 0;
    
  if (value > 511)
    {
      LEGO_Display.setColor(0,255,0);      
      LEGO_Display.fillRoundRect(x_output, y_output+(line*(output_height+2)), x_output+output_width, y_output+(line*(output_height+2)) + output_height);                     
    }
   else
    {
      LEGO_Display.setColor(50,50,50);      
      LEGO_Display.fillRoundRect(x_output, y_output+(line*(output_height+2)), x_output+output_width, y_output+(line*(output_height+2)) + output_height);                     
    }
  LEGO_Display.setColor(0,0,0);  
  LEGO_Display.drawRoundRect(x_output, y_output+(line*(output_height+2)), x_output+output_width, y_output+(line*(output_height+2)) + output_height);                 
  
 }
''