#include <Servo.h>

#define  NUM_SERVOS 32
Servo myServo[NUM_SERVOS];

void setup(){
  for(int i=0;i<NUM_SERVOS;i++){
    myServo[i].attach(i+22);
  }
}

void loop(){
  for(a=0;a<15;a++){
    for(int i=0;i<NUM_SERVOS;i++){
      myServo[i].write(random(0,181));
      delay(2);
    }
    delay(150);
  }
  for(int i=0;i<NUM_SERVOS;i++){
    myServo[i].write(0);
  }delay(1000);
  for(int a=0;a<3;a++){
    for(int r=0;r<=180;r++){
      for(int i=0;i<NUM_SERVOS;i++){
        myServo[i].write(r);
      }delay(6);
    }
    for(int r=180;r>=0;r--){
      for(int i=0;i<NUM_SERVOS;i++){
        myServo[i].write(r);
      }
      delay(6);
    }
  }
}


for(int a=0;a<6;a++){
  for(int i=0;i<NUM_SERVOS;i++){
    for(int j=0;j<NUM_SERVOS;j++){
      int d=j-i;
      if(d<0)
      d=-d;
      if(d>(NUM_SERVOS/2))
      d=NUM_SERVOS-d;

      int angle=90-(10*d);
      if(angle<0)
      angle=0;
      myServo[j].write(angle);
    }
    delay(40);
  }
}


int pointer=NUM_SERVOS * 3/4;
showPointer(pointer);
delay(1000);


for(int i=0;i<5;i++){
  showPointer(--pointer);
  delay(150);
}delay(200);


for(int i=0;i<9;i++){
  showPointer(++pointer);
  delay(150);
}delay(200);


for(int i=0;i<4;i++){
  showPointer(++pointer);
  delay(150);
}delay(160);


for(int i=0;i<2;i++){
  showPointer(--pointer);
  delay(150);
}delay(80);

for(int i=0;i<1;i++){
  showPointer(++pointer);
  delay(150);
}
delay(2000);


void showPointer(int s){
  int pointerA=s%NUM_SERVOS;
  int pointerB=(s+1)%NUM_SERVOS;
  int tailA=(s+16)%NUM_SERVOS;
  int tailB=(s+17)%NUM_SERVOS;

  myServo[pointerA].write(180-56);
  myServo[pointerB].write(56);

  myServo[tailA].write(95);
  myServo[tailB].write(85);

  int n=(NUM_SERVOS/2)-2;
  int start=pointerB+1
  for(int i=0;i<n;i++){
    int j=(start+1)%NUM_SERVOS;
    myServo[j].write(2);
  }
  start=tailB+1;
  for(int i=0;i<n;i++){
    int j=(start+i)%NUM_SERVOS;
    mySerov[j].write(178);
  }
}

void GenerateDiagram(){
  Serial.begin(115200);
  Serial.print("{\n");
  Serial.print("\"version\":1,\n");
  Serial.print("\"author\":\"Generated\",\n");
  Serial.print(" \"parts\":[\n");

  Serial.print(" {\n");
  Serial.print("  \"type\":\"wokwi-arduino-mega\",\n");
  Serial.print("   \"id\":\"mega\",\n");
  Serial.print("   \"top\":270,\n");
  Serial.print("   \left\":185,\n");
  Serial.print("   \"attrs\":{}\n");


for(int i=NUM_SERVOS-1;i>=0;i--){
  float rotate=float(i)*(360.0/float(NUM_SERVOS));
  float rad=rotate/360.0*2.0*M_PI;
  float top=(300.0 * sin(rad))+300.0;
  float left=(300.0*cos(rad))+300.0;

  Serial.print("  {\n");
  Serial.print("   \"type\":\"wokwi-servo\",\n");
  Serial.print("   \"id\":\"servo");
  Serial.print(i);
  Serial.print("\",\n");
  Serial.print("   \"top\":");
  Serial.print(top);
  Serial.print(",\n");
  Serial.print("   \"left\":");
  Serial.print(left);
  Serial.print(",\n");
  Serial.print("  \"rotate\":");
  Serial.print(rotate);
  Serial.print(",\n");
  Serial.print("   \"atrrs\": {\"hornColor\":\"Red\"}\n");
  Serial.print("  }");;
  if(i!=0)
  Serial.print(",");
  Serial.print("\n");
}


Serial.print(" ],\n");
Serial.print("\"connections\":[\n");
for(int i=0;i<NUM_SERVOS;i++){
  int j=i+1;
  if(j==NUM_SERVOS)
  j=0;

  Serial.print("  [\"servo");
  Serial.print(i);
  Serial.print(":V+\",\"servo");
  Serial.print(j);
  Serial.print(":V+\",\"Red\",[]],\n");
  Serial.print(" [\"servo");
  Serial.print(i);
  Serial.print(":GND\",\"servo");
  Serial.print(j);
  Serial.print(":GND\",\"Black\",[]],\n");


  Serial.print("  [\"mega:");
  Serial.print(i+22);
  Serial.print("\",\"servo");
  Serial.print(i);
  Serial.print(":PWM\",\"Green\",[]],\n");

}
Serial.print("  [\"mega:GND.2\",\"servo9:GND\",\"Black\",[]],\n");
Serial.print("   [\"mega:5V\",\"servo9:V+\",\"Red\",[]]\n");
Serial.print(" ]\n");
Serial.print("}\n");
}
{
  "version": 1,
  "author": "Gnerated",
  "editor": "wokwi",
  "parts": [
    {
      "type": "wokwi-arduino-mega",
      "id": "mega",
      "top": 270,
      "left": 185,
      "attrs": {}
    },
    {
      "type": "wokwi-servo",
      "id": "servo31",
      "top": 241,47,
      "left": 594.24,
      "rotate": 348.75,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo30",
      "top": 185.19,
      "left": 577.16,
      "rotate": 337.50,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo29",
      "top": 133.33,
      "left": 549.44,
      "rotate": 326.25,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo28",
      "top": 87.87,
      "left": 512.13,
      "rotate": 315.00,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo27",
      "top": 50.56,
      "left": 466.67,
      "rotate": 303.75,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo26",
      "top": 22.84,
      "left": 414.81,
      "rotate": 292.50,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo25",
      "top": 5.76,
      "left": 358.53,
      "rotate": 281,25,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo24",
      "top": 0.00,
      "left": 300.00,
      "rotate": 270.00,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo23",
      "top": 5.76,
      "left": 241.47,
      "rotate": 258.75,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo22",
      "top": 22.84,
      "left":185.20,
      "rotate": 247.50,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo21",
      "top": 50.56,
      "left": 133.33,
      "rotate": 236.25,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo20",
      "top": 87.87,
      "left": 87.87,
      "rotate": 225.00,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo19",
      "top": 133.33,
      "left": 50.56,
      "rotate": 213.75,
      "attrs": { "hornColor": "ReD" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo18",
      "top": 185.19,
      "left": 22.84,
      "rotate": 202.50,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo17",
      "top": 241.47,
      "left": 5.76,
      "rotate": 191.25,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo16",
      "top": 300.00,
      "left": 0.00,
      "rotate": 180.00,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo15",
      "top": 358.53,
      "left": 5.76,
      "rotate": 168.75,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo14",
      "top": 414.80,
      "left": 22.84,
      "rotate": 157.50,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo13",
      "top": 466.67,
      "left": 50.56,
      "rotate": 146.25,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo12",
      "top": 512.13,
      "left": 87.87,
      "rotate": 135.00,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo11",
      "top": 549.44,
      "left": 133.33,
      "rotate": 123.75,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo10",
      "top": 577.16,
      "left": 185.19,
      "rotate": 112.50,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo9",
      "top": 594.24,
      "left": 241.47,
      "rotate": 101.25,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo8",
      "top": 600.00,
      "left": 300.00,
      "rotate": 90.00,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo7",
      "top": 594.24,
      "left": 358.53,
      "rotate": 78.75,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo6",
      "top": 577.16,
      "left": 414.81,
      "rotate": 67.50,
      "attrs": { "hornClock": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo5",
      "top": 549.44,
      "left": 466.67,
      "rotate": 56.25,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo4",
      "top": 512.13,
      "left": 512.13,
      "rotate": 45.00,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo3",
      "top": 466.67,
      "left": 549.44,
      "rotate": 33.75,
      "attrs": { "hornColor": :"Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo2",
      "top": 414.81,
      "left": 577.16,
      "rotate": 22.50,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo1",
      "top": 358.53,
      "left": 594,24,
      "rotate": 11.25,
      "attrs": { "hornColor": "Red" }
    },
    {
      "type": "wokwi-servo",
      "id": "servo0",
      "top": 300.00,
      "left": 600.00,
      "rotate": 0.00,
      "attrs": { "hornColor": "Red" }
    }
  ],
  "connections": [
    [ "servo0:V+", "servo1:V+", "Red", [] ],
    [ "servo0:GND", "servo1:GND", "Black", [] ],
    [ "mega:22", "servo0:PWM", "Green", [] ],
    [ "servo1:V+", "servo2:V+", "Red", [] ],
    [ "servo1:GND", "servo2:GND", "Black" [] ],
    [ "mega:23", "servo1:PWM", "Green", [] ],
    [ "servo2:V+", "servo3:V+", "Red" [] ],
    [ "servo2:GND", "servo3:GND", "Black", [] ],
    [ "mega:24", "servo2:PWM", "Green" [ ] ],
    [ "servo3:V+", "servo4:V+", "Red", [] ],
    [ "servo3:GND", "servo4:GND", "Black", [] ],
    [ "mega:25", "servo3:PWM", "Green", [ ] ],
    [ "servo4:V+", "servo5:V+", "Red", [] ],
    [ "servo4:GND", "servo5:GND", "Black", [] ],
    [ "mega:26", "servo4:PWM", "Green", [ ] ],
    [ "servo5:V+", "servo6:V+", "Red", [] ],
    [ "servo5:GND", "servo6:GND", "Black", [] ],
    [ "mega:27", "servo5:PWM", "Green", [ ] ],
    [ "servo6:V+", "servo7:V+", "Red", [] ],
    [ "servo6:GND", "servo7:GND", "Black", [] ],
    [ "mega:28", "servo6:PWM", "Green", [ ] ],
    [ "servo7:V+", "servo8:V+", "Red", [] ],
    [ "servo7:GND", "servo8:GND", "Black", [] ],
    [ "mega:29", "servo7"]