//import processing.opengl.*;

int NUMACTORS = 50;
int i = 0;

int rNum1, rNum2;

int blur=20;
boolean released = true;

Actor actors[] = new Actor[NUMACTORS];

void setup(){
  size(500,500,P3D);
  reset();
  ellipseMode(CENTER_RADIUS);
  background(0);
  //smooth();
}

void draw(){
  noStroke();
  fill(0,blur);
  rect(0,0,width,height);
  
  if(keyPressed && released){
    switch(key){
      case ' ':
        reset();
        break;
      case 'b':
        if(blur == 255){
          blur = 20;
        }else{
          blur = 255;
        }
        break;
      default:
        break;
    }
    released = false;
  }
  
  for(i = 0; i < NUMACTORS; i++){
    actors[i].step();
  }
}

void keyReleased(){
  released = true;
}

void reset(){
  for(i = 0; i < NUMACTORS; i++){
    actors[i] = new Actor(random(0,width), random(0,height), random(1,10), actors, NUMACTORS);
    //actors[i].attach((int)random(0,NUMACTORS-1) , (int)random(0,NUMACTORS-1));
    actors[i].attach((i+1)%NUMACTORS, (NUMACTORS-(i-1))%NUMACTORS);
  }
}

class Actor{
  float x,y,m;

  float vx,vy;
  float ax,ay;
  float fx,fy;

  Actor actors[];

  int follow,avoid;
  int NUMACTORS;
  float F = .1;
  float A = 5;
  float DAMP = .995;
  int STEPS = 10;
  float POINTALPHA = 255-100;
  int POINTCOLOR = 255;
  float POINTRADIUS = 1.5;
  Vector aforce = new Vector(0,0);
  Vector fforce = new Vector(0,0);

  Actor(float x, float y, float m, Actor[] actors, int NUMACTORS){
    this.x=x;
    this.y=y;
    this.m=m;
    this.actors = actors;
    this.NUMACTORS = actors.length;
  }

  void attach(int follow, int avoid){
    this.follow = follow;
    this.avoid = avoid;
  }

  void step(){
    for(int i = 0; i<STEPS; i++){

      aforce.t = atan2(y-actors[avoid].y, x-actors[avoid].x);
      if(dist(x,y,actors[avoid].x,actors[avoid].y)!=0){
        aforce.r = .1/dist(x,y,actors[avoid].x,actors[avoid].y);
      }
      
      fforce.t = atan2(actors[follow].y-y, actors[follow].x-x);
      fforce.r = dist(x,y,actors[follow].x,actors[follow].y)*.1;
      
      fx = (aforce.x()+fforce.x())/1000;
      fy = (aforce.y()+fforce.y())/1000;
      
      //if(keyPressed){fx=0;fy=0;}
      
      //f = m*a
      //a = f*(1/m)
      ax = fx/m ;
      ay = fy/m ;

      //v = a*t
      //v' = a
      vx = DAMP*(vx+ax);
      vy = DAMP*(vy+ay);
      
      //d = v*t
      //d' = v
      x += vx;
      y += vy;

      noStroke();//stroke(POINTCOLOR, POINTALPHA);
      fill(POINTCOLOR,POINTALPHA);
      ellipse(x,y,POINTRADIUS,POINTRADIUS);
    }
  }
}

class Vector {
  float r,t;
  
  Vector (float r, float t){
    this.r=r;
    this.t=t;
  }
  
  float x() {
    return r*cos(t);
  }
  
  float y() {
    return r*sin(t);
  }
}

/*class Actor{
  float x,y,m;

  float rx,ry;
  float ax,ay;
  float fx,fy;

  Actor actors[];

  int follow;
  int avoid;
  int NUMACTORS;
  float FK = -.11;
  float AK = .110;
  float DAMP = .3;
  int STEPS = 1;
  float POINTALPHA = 50;
  int POINTCOLOR = 255;
  float POINTRADIUS = 1.5;
  float aangle,astrength;
  float fangle,fstrength;
  
  Actor(float x, float y, float m, Actor[] actors, int NUMACTORS){
    this.x=x;
    this.y=y;
    this.m=m;
    this.actors = actors;
  }

  void attach(int follow, int avoid){
    this.follow = follow;
    this.avoid = avoid;
  }

  void step(){

    //f = k*(distance to followed) - k*(distance to avoided)
    for(int i = 0; i<STEPS; i++){

      aangle = (PI/2)-atan2(x-actors[avoid].x,y-actors[avoid].y);//avoid.x-x,avoid.y-y);
      astrength = 100/dist(x,y,actors[avoid].x,actors[avoid].y);
      
      fangle = (PI/2)-atan2(actors[follow].x-x,actors[follow].y-y);
      fstrength = 100/dist(x,y,actors[follow].x,actors[follow].y);
      
      fx=fstrength*cos(fangle) + astrength*cos(aangle);
      fy=fstrength*sin(fangle) + astrength*sin(aangle);
      
      //while(keyPressed){}
      println(x+ " " + y);

      //f = m*a
      //a = f*(1/m)
      ax = fx/m ;
      ay = fy/m ;

      //r = a*t
      //r' = a
      rx = DAMP*(rx+ax);
      ry = DAMP*(ry+ay);

      //d = r*t
      //d' = r
      x += rx;
      y += ry;

      noStroke();//stroke(POINTCOLOR, POINTALPHA);
      fill(POINTCOLOR,POINTALPHA);
      ellipse(x,y,POINTRADIUS,POINTRADIUS);
    }
  }
}*/