#include <Adafruit_GFX.h> 
#include <SPI.h> 
#include <Adafruit_ILI9341.h> 
#include <Wire.h> 
#include <Adafruit_FT6206.h> 
Adafruit_FT6206 ctp = Adafruit_FT6206(); 
#define TFT_CS 10 
#define TFT_DC 9 
Adafruit_ILI9341 tft = Adafruit_ILI9341(TFT_CS, TFT_DC); 
#define BOXSIZE 40 
#define PENRADIUS 3 
int oldcolor, currentcolor; 
void setup(void) { 
 while (!Serial); 
 Serial.begin(115200); Serial.println(F("Cap Touch Paint!"));  tft.begin(); 
 if (!ctp.begin(40)) { 
 Serial.println("Couldn't start FT6206 touchscreen controller");  while (1); 
 } 
 Serial.println("Capacitive touchscreen started");  tft.fillScreen(ILI9341_BLACK); 
 tft.fillRect(0, 0, BOXSIZE, BOXSIZE, ILI9341_RED);  tft.fillRect(BOXSIZE, 0, BOXSIZE, BOXSIZE, ILI9341_YELLOW);  tft.fillRect(BOXSIZE * 2, 0, BOXSIZE, BOXSIZE, ILI9341_GREEN);  tft.fillRect(BOXSIZE * 3, 0, BOXSIZE, BOXSIZE, ILI9341_CYAN);  tft.fillRect(BOXSIZE * 4, 0, BOXSIZE, BOXSIZE, ILI9341_BLUE);  tft.fillRect(BOXSIZE * 5, 0, BOXSIZE, BOXSIZE, ILI9341_MAGENTA); 
 tft.drawRect(0, 0, BOXSIZE, BOXSIZE, ILI9341_WHITE);  currentcolor = ILI9341_RED; 
} 
void loop() { 
 if (!ctp.touched()) { 
 return; 
 } 
 TS_Point p = ctp.getPoint(); 
 p.x = map(p.x, 0, 240, 240, 0); 
 p.y = map(p.y, 0, 320, 320, 0); 
 Serial.print("("); Serial.print(p.x); 
 Serial.print(", "); Serial.print(p.y); Serial.println(")");
 if (p.y < BOXSIZE) { 
 oldcolor = currentcolor; 
 if (p.x < BOXSIZE) { 
 currentcolor = ILI9341_RED; 
 tft.drawRect(0, 0, BOXSIZE, BOXSIZE, ILI9341_WHITE);  } else if (p.x < BOXSIZE * 2) { 
 currentcolor = ILI9341_YELLOW; 
 tft.drawRect(BOXSIZE, 0, BOXSIZE, BOXSIZE, ILI9341_WHITE);  } else if (p.x < BOXSIZE * 3) { 
 currentcolor = ILI9341_GREEN; 
 tft.drawRect(BOXSIZE * 2, 0, BOXSIZE, BOXSIZE, ILI9341_WHITE);  } else if (p.x < BOXSIZE * 4) { 
 currentcolor = ILI9341_CYAN; 
 tft.drawRect(BOXSIZE * 3, 0, BOXSIZE, BOXSIZE, ILI9341_WHITE);  } else if (p.x < BOXSIZE * 5) { 
 currentcolor = ILI9341_BLUE; 
 tft.drawRect(BOXSIZE * 4, 0, BOXSIZE, BOXSIZE, ILI9341_WHITE);  } else if (p.x <= BOXSIZE * 6) { 
 currentcolor = ILI9341_MAGENTA; 
 tft.drawRect(BOXSIZE * 5, 0, BOXSIZE, BOXSIZE, ILI9341_WHITE);  } 
 if (oldcolor != currentcolor) { 
 if (oldcolor == ILI9341_RED) 
 tft.fillRect(0, 0, BOXSIZE, BOXSIZE, ILI9341_RED);  if (oldcolor == ILI9341_YELLOW) 
 tft.fillRect(BOXSIZE, 0, BOXSIZE, BOXSIZE, ILI9341_YELLOW);  if (oldcolor == ILI9341_GREEN) 
 tft.fillRect(BOXSIZE * 2, 0, BOXSIZE, BOXSIZE, ILI9341_GREEN);  if (oldcolor == ILI9341_CYAN) 
 tft.fillRect(BOXSIZE * 3, 0, BOXSIZE, BOXSIZE, ILI9341_CYAN);  if (oldcolor == ILI9341_BLUE) 
 tft.fillRect(BOXSIZE * 4, 0, BOXSIZE, BOXSIZE, ILI9341_BLUE);  if (oldcolor == ILI9341_MAGENTA) 
 tft.fillRect(BOXSIZE * 5, 0, BOXSIZE, BOXSIZE, ILI9341_MAGENTA);  } 
 } 
 if (((p.y - PENRADIUS) > BOXSIZE) && ((p.y + PENRADIUS) < tft.height())) {  tft.fillCircle(p.x, p.y, PENRADIUS, currentcolor); 
 } 
}