#include <Servo.h>
Servo myservo;
#include <Wire.h>
#include <Adafruit_GFX.h>
#include <Adafruit_SSD1306.h>
Adafruit_SSD1306 display(128, 64, &Wire, -1);
int Gradi;
int x;
int y;
int v;
int w;
void setup() {
  myservo.attach(11);
  display.begin(SSD1306_SWITCHCAPVCC, 0x3C);
  display.clearDisplay();
  display.display();

  pinMode(2, INPUT);
}
void loop() {
  display.clearDisplay();
  // quadratini 
  for (int i=15 ;i<=31; i=i+4)
    {
      //sinistra
display.fillRect(i,24,2,2,WHITE);
display.fillRect(i+2,26,2,2,WHITE);      
display.fillRect(i,28,2,2,WHITE);
display.fillRect(i+2,30,2,2,WHITE);
display.fillRect(i,32,2,2,WHITE);
display.fillRect(i+2,34,2,2,WHITE);
display.fillRect(i,36,2,2,WHITE);
display.fillRect(i+2,38,2,2,WHITE);
display.fillRect(i,40,2,2,WHITE);

// destra
display.fillRect(i+82,24,2,2,WHITE);
display.fillRect(i+84,26,2,2,WHITE);      
display.fillRect(i+82,28,2,2,WHITE);
display.fillRect(i+84,30,2,2,WHITE);
display.fillRect(i+82,32,2,2,WHITE);
display.fillRect(i+84,34,2,2,WHITE);
display.fillRect(i+82,36,2,2,WHITE);
display.fillRect(i+84,38,2,2,WHITE);
display.fillRect(i+82,40,2,2,WHITE);
  }
display.drawCircle(23,32,9,BLACK);
display.drawCircle(23,32,10,BLACK); 
display.drawCircle(23,32,11,BLACK);
display.drawCircle(23,32,12,BLACK);
display.drawCircle(23,32,13,BLACK);
display.drawCircle(23,32,14,BLACK);
display.drawCircle(23,32,15,BLACK);
display.drawCircle(105,32,9,BLACK);
display.drawCircle(105,32,10,BLACK); 
display.drawCircle(105,32,11,BLACK);
display.drawCircle(105,32,12,BLACK);
display.drawCircle(105,32,13,BLACK);
display.drawCircle(105,32,14,BLACK);
display.drawCircle(105,32,15,BLACK);
// fine quadratini
  //cerchi
//display.fillCircle(23,32,8,WHITE);
display.drawCircle(23,32,10,WHITE);
display.drawCircle(23,32,12,WHITE);
display.drawCircle(23,32,14,WHITE);
display.drawCircle(23,32,18,WHITE);
display.drawCircle(23,32,19,WHITE);
display.drawCircle(23,32,20,WHITE);
display.drawCircle(23,32,21,WHITE);
//display.fillCircle(105,32,8,WHITE);
display.drawCircle(105,32,10,WHITE);
display.drawCircle(105,32,12,WHITE);
display.drawCircle(105,32,14,WHITE);
display.drawCircle(105,32,18,WHITE);
display.drawCircle(105,32,19,WHITE);
display.drawCircle(105,32,20,WHITE);
display.drawCircle(105,32,21,WHITE);

//ovale
display.drawRoundRect(48,3,32,12,5,WHITE);
display.setCursor(45,17);
display.setTextColor(WHITE);
display.setTextSize(1);
display.print("HC-SR04");

//4 cerchi
display.drawCircle(5,5,3,WHITE);
display.drawCircle(5,59,3,WHITE);
display.drawCircle(123,5,3,WHITE);
display.drawCircle(123,59,3,WHITE);

//connettore
display.drawRect(51,54,6,6,WHITE);
display.fillRect(53,56,2,8,WHITE);
display.drawRect(58,54,6,6,WHITE);
display.fillRect(60,56,2,8,WHITE);
display.drawRect(65,54,6,6,WHITE);
display.fillRect(67,56,2,8,WHITE);
display.drawRect(72,54,6,6,WHITE);
display.fillRect(74,56,2,8,WHITE);

display.display();

// Altra immagine per animazione
delay(2000);
display.clearDisplay();
 // quadratini 
  for (int i=15 ;i<=31; i=i+4)
    {
      //sinistra
display.fillRect(i,24,2,2,WHITE);
display.fillRect(i+2,26,2,2,WHITE);      
display.fillRect(i,28,2,2,WHITE);
display.fillRect(i+2,30,2,2,WHITE);
display.fillRect(i,32,2,2,WHITE);
display.fillRect(i+2,34,2,2,WHITE);
display.fillRect(i,36,2,2,WHITE);
display.fillRect(i+2,38,2,2,WHITE);
display.fillRect(i,40,2,2,WHITE);

// destra
display.fillRect(i+82,24,2,2,WHITE);
display.fillRect(i+84,26,2,2,WHITE);      
display.fillRect(i+82,28,2,2,WHITE);
display.fillRect(i+84,30,2,2,WHITE);
display.fillRect(i+82,32,2,2,WHITE);
display.fillRect(i+84,34,2,2,WHITE);
display.fillRect(i+82,36,2,2,WHITE);
display.fillRect(i+84,38,2,2,WHITE);
display.fillRect(i+82,40,2,2,WHITE);
  }

display.drawCircle(23,32,9,BLACK);
display.drawCircle(23,32,10,BLACK); 
display.drawCircle(23,32,11,BLACK);
display.drawCircle(23,32,12,BLACK);
display.drawCircle(23,32,13,BLACK);
display.drawCircle(23,32,14,BLACK);
display.drawCircle(23,32,15,BLACK);
display.drawCircle(105,32,9,BLACK);
display.drawCircle(105,32,10,BLACK); 
display.drawCircle(105,32,11,BLACK);
display.drawCircle(105,32,12,BLACK);
display.drawCircle(105,32,13,BLACK);
display.drawCircle(105,32,14,BLACK);
display.drawCircle(105,32,15,BLACK);
// fine quadratini

//display.fillCircle(23,32,8,WHITE);
display.drawCircle(23,32,11,WHITE);
display.drawCircle(23,32,13,WHITE);
display.drawCircle(23,32,15,WHITE);
display.drawCircle(23,32,18,WHITE);
display.drawCircle(23,32,19,WHITE);
display.drawCircle(23,32,20,WHITE);
display.drawCircle(23,32,21,WHITE);
//display.fillCircle(105,32,8,WHITE);
display.drawCircle(105,32,11,WHITE);
display.drawCircle(105,32,13,WHITE);
display.drawCircle(105,32,15,WHITE);
display.drawCircle(105,32,18,WHITE);
display.drawCircle(105,32,19,WHITE);
display.drawCircle(105,32,20,WHITE);
display.drawCircle(105,32,21,WHITE);

//ovale
display.drawRoundRect(48,3,32,12,5,WHITE);
display.setCursor(45,17);
display.setTextColor(WHITE);
display.setTextSize(1);
display.print("HC-SR04");

//4 cerchi
display.drawCircle(5,5,3,WHITE);
display.drawCircle(5,59,3,WHITE);
display.drawCircle(123,5,3,WHITE);
display.drawCircle(123,59,3,WHITE);

//connettore
display.drawRect(51,54,6,6,WHITE);
display.fillRect(53,56,2,8,WHITE);
display.drawRect(58,54,6,6,WHITE);
display.fillRect(60,56,2,8,WHITE);
display.drawRect(65,54,6,6,WHITE);
display.fillRect(67,56,2,8,WHITE);
display.drawRect(72,54,6,6,WHITE);
display.fillRect(74,56,2,8,WHITE);

display.display();
}