import toxi.geom.*;

int numSegments=50;
int maxNumLinks=100;
int depth=15;
int colorstep=10;
int alphastep=10;
float framesPerY;
float framesPerX;
int numWalkers=10000;

ArrayList segs = new ArrayList();
ArrayList links = new ArrayList();
ArrayList tempsegs = new ArrayList();
ArrayList allnodes = new ArrayList();

Nodewalker[] walkers; 

PGraphics lores;

void setup(){
  size(800,800,P3D);
  background(255);
  frameRate(20);
  initialize();
  lores=createGraphics(200,200,P3D);

} 

void draw(){

background(255);
/*for(int i=0;i<numWalkers;i++){
    walkers[i].update();  
  }*/
  lores.beginDraw();
  lores.background(0); 
  lores.translate(lores.width/2,lores.height/2,0);
  lores.rotateY(frameCount/framesPerY);
  lores.rotateX(frameCount/framesPerX);
  lores.stroke(255,0,0);
  for(int i=0;i<numWalkers;i++){


    lores.point(walkers[i].position.x*0.25f,walkers[i].position.y*0.25f,walkers[i].position.z*0.25f);

  }
  lores.filter(BLUR,2);
  lores.endDraw();
  blend(lores,0,0,200,200,0,0,800,800,BLEND);
 
 translate(width/2,height/2,0);
rotateY(frameCount/framesPerY);
rotateX(frameCount/framesPerX);
fill(255,10);
noStroke();
  for(int i=0;i<numWalkers;i+=10){


   walkers[i].draw();

  }
  
 


}

float d(Vec3D p1, Vec3D p2, Vec3D p3, Vec3D p4){
  return((p1.x-p2.x)*(p3.x-p4.x)+(p1.y-p2.y)*(p3.y-p4.y)+(p1.z-p2.z)*(p3.z-p4.z));

}

Segment closestLink(Segment s1, Segment s2){
  Segment result = null;
  Vec3D s1pStart = new Vec3D(s1.start.position);
  Vec3D s1pEnd = new Vec3D(s1.end.position);
  Vec3D s2pStart = new Vec3D(s2.start.position);
  Vec3D s2pEnd = new Vec3D(s2.end.position);
  float mu1 =  d(s1pStart,s2pStart,s2pEnd,s2pStart)*d(s2pEnd,s2pStart,s1pEnd,s1pStart);   
  mu1-=d(s1pStart,s2pStart,s1pEnd,s1pStart)*d(s2pEnd,s2pStart,s1pEnd,s1pStart); 
  mu1/=(d(s1pEnd,s1pStart,s1pEnd,s1pStart)*d(s2pEnd,s2pStart,s2pEnd,s2pStart)-d(s2pEnd,s2pStart,s1pEnd,s1pStart)*d(s2pEnd,s2pStart,s1pEnd,s1pStart));
  float mu2 =(d(s1pStart,s2pStart,s2pEnd,s2pStart)+mu1*d(s2pEnd,s2pStart,s1pEnd,s1pStart))/d(s2pEnd,s2pStart,s1pEnd,s1pStart);
  if((mu1>=0.0f)&&(mu1<=1.0f)&&(mu2>=0.0f)&&(mu2<=1.0f)){
    Vec3D p1 = ((s1pEnd.sub(s1pStart)).scale(mu1)).add(s1pStart);
    Vec3D p2 = ((s2pEnd.sub(s2pStart)).scale(mu2)).add(s2pStart);
    result =new Segment(p1,p2);
  }
  return result;

}

void initialize(){
  clearAll();
  for(int i=0;i<numSegments;i++){
    segs.add(new Segment(Vec3D.randomVector().scale(0.7f*width),Vec3D.randomVector().scale(0.7f*height)));
  }
  for(int i=0;i<segs.size();i++){
    for(int j=i+1;j<segs.size();j++){
      Segment sij = closestLink((Segment)segs.get(i),(Segment)segs.get(j));
      if ((sij != null)&&(links.size()<maxNumLinks)){

        ((Segment)segs.get(i)).start.add(sij.start);
        ((Segment)segs.get(i)).end.add(sij.start);
        ((Segment)segs.get(j)).start.add(sij.end);
        ((Segment)segs.get(j)).end.add(sij.end);
        sij.start.add(((Segment)segs.get(i)).start);
        sij.start.add(((Segment)segs.get(i)).end);
        sij.end.add(((Segment)segs.get(j)).start);
        sij.end.add(((Segment)segs.get(j)).end);
        links.add(sij);
      }
    }
  }
  for(int c=1;c<depth;c++){
    tempsegs.clear();
    tempsegs.addAll(segs);
    segs.clear();
    segs.addAll(links);
    links.clear();
    for(int i=0;i<segs.size();i++){
      for(int j=i+1;j<segs.size();j++){
        Segment sij = closestLink((Segment)segs.get(i),(Segment)segs.get(j));
        if ((sij != null)&&(links.size()<maxNumLinks)){

          ((Segment)segs.get(i)).start.add(sij.start);
          ((Segment)segs.get(i)).end.add(sij.start);
          ((Segment)segs.get(j)).start.add(sij.end);
          ((Segment)segs.get(j)).end.add(sij.end);
          sij.start.add(((Segment)segs.get(i)).start);
          sij.start.add(((Segment)segs.get(i)).end);
          sij.end.add(((Segment)segs.get(j)).start);
          sij.end.add(((Segment)segs.get(j)).end);
          links.add(sij);
        }
      }
    }

    for(int i=0;i<segs.size();i++){
      ((Segment)segs.get(i)).c=color(20+c*colorstep,0,0,20+c*alphastep);
    }
    segs.addAll(tempsegs);
  }

  framesPerY=random(200.0f,1000.0f)*((random(1.0)<0.5f)?-1.0f:1.0f);
  framesPerX=random(200.0f,1000.0f)*((random(1.0)<0.5f)?-1.0f:1.0f);
  for(int i=0;i<segs.size();i++){
    Segment si= (Segment)segs.get(i);
    allnodes.add(si.start);
    allnodes.add(si.end);
  }
  walkers = new Nodewalker[numWalkers];
  for(int i=0;i<numWalkers;i++){
    walkers[i] = new Nodewalker(allnodes);
  }


}
void clearAll(){
  segs.clear();
  links.clear();
  tempsegs.clear();
  allnodes.clear();
  
  }

void mouseClicked(){
initialize();

}