int WIDTH=350;
int HEIGHT=490;
float ECOL=0.9;
float EDRAG=0.999;
float EG=0.5;
int N;
int NS;
//long CT=0;
int ITT=5;

float[] PX = new float[8];
float[] PY = new float[8];
float[] PX_OLD = new float[8];
float[] PY_OLD = new float[8];

int STICKA[] = new int[9];
int STICKB[] = new int[9];
float STICKLENGTH[] = new float[9];
boolean PINNED[]= new boolean [8];

boolean RUNNING=true;

boolean GRAVITY=true;

void setup() {
  size(400, 550, P2D);
  reset();
  for (int i=0;i<6;i++) {PINNED[i]=false;}
  PINNED[7]=true;
}

void draw() {

background(0,0,0,0);
noFill();
stroke(255);
rect(0,0,WIDTH,HEIGHT);

renderbuttons();
//if(CT++>3000) {reset(); RUNNING=false;} //fuze

if (RUNNING) {
updatepoints();

for (int i=0;i<ITT;i++) {
updatesticks();
constrainpoints();
}


}

if (mousePressed && (mouseButton == LEFT) && RUNNING) {nickmouse();}
renderpoints();

}

void renderpoints() {

 
stroke(164,164,164); 
fill(32,32,160);
beginShape();
vertex(PX[0],PY[0]);  
vertex(PX[1],PY[1]);  
vertex(PX[3],PY[3]);  
vertex(PX[2],PY[2]);
vertex(PX[0],PY[0]); 
endShape();

line(PX[0],PY[0],PX[4],PY[4]);
line(PX[4],PY[4],PX[5],PY[5]);
line(PX[5],PY[5],PX[6],PY[6]);
line(PX[6],PY[6],PX[7],PY[7]);

ellipse(PX[7],PY[7],3,3);

}

void updatesticks() {
for (int i=0;i<NS;i++) {
  float dx,dy, dist, diff, percent, offx, offy;
  dx=PX[STICKA[i]]-PX[STICKB[i]];
  dy=PY[STICKA[i]]-PY[STICKB[i]];
  dist=sqrt((dx*dx)+(dy*dy));
  diff=STICKLENGTH[i]-dist;
  percent=diff/dist/2;
  offx=dx*percent;
  offy=dy*percent;
  
 if (!PINNED[STICKB[i]]) { PX[STICKB[i]]-=offx;  PY[STICKB[i]]-=offy;}
 if (!PINNED[STICKA[i]]) { PX[STICKA[i]]+=offx;  PY[STICKA[i]]+=offy;}
}
}


void constrainpoints() {
 
 float VX,VY;

for (int i=0;i<N;i++)
{

  
  VX=(PX[i]-PX_OLD[i])*EDRAG;
  VY=(PY[i]-PY_OLD[i])*EDRAG;


if (PX[i]>WIDTH) 
 {
   PX[i]=WIDTH;
   PX_OLD[i]=(PX[i]+(VX*ECOL));
 }
 else if (PX[i]<0)
  {
    PX[i]=0;
    PX_OLD[i]=(PX[i]+(VX*ECOL));
  }
  
  if (PY[i]>HEIGHT) 
 {
   PY[i]=HEIGHT;
   PY_OLD[i]=(PY[i]+(VY*ECOL));
 }
 else if (PY[i]<0)
  {
    PY[i]=0;
    PY_OLD[i]=(PY[i]+(VY*ECOL));
  }
  
} 

}




void updatepoints() {
 
 float VX,VY;

for (int i=0;i<N;i++)
{
 
  if (!PINNED[i]) {
  
  VX=(PX[i]-PX_OLD[i])*EDRAG;
  VY=(PY[i]-PY_OLD[i])*EDRAG;
  PX_OLD[i]=PX[i];
  PY_OLD[i]=PY[i];
  PX[i]+=VX;
  PY[i]+=VY;
  PY[i]+=EG;

  }

} 

}

void reset() {


  
   N=7;NS=9;
   four();
   
   for (int i=4;i<8;i++){
   PX[i]=PX[0];PY[i]=PY[0];
   PX_OLD[i]=PX[0];PY_OLD[i]=PY[0];
   }
   
   STICKA[0]=0;STICKB[0]=1;STICKLENGTH[0]=calclength(0,1);
   STICKA[1]=0;STICKB[1]=2;STICKLENGTH[1]=calclength(0,2);
   STICKA[2]=1;STICKB[2]=3;STICKLENGTH[2]=calclength(1,3);
   STICKA[3]=2;STICKB[3]=3;STICKLENGTH[3]=calclength(2,3);
   STICKA[4]=0;STICKB[4]=3;STICKLENGTH[4]=calclength(0,3);
  //chain
   STICKA[5]=0;STICKB[5]=4;STICKLENGTH[5]=20;
   STICKA[6]=4;STICKB[6]=5;STICKLENGTH[6]=20;
   STICKA[7]=5;STICKB[7]=6;STICKLENGTH[7]=20;
   STICKA[8]=6;STICKB[8]=7;STICKLENGTH[8]=20;
  

RUNNING=false;

}


void four() {
float MX,MY, randr, randangle, opp, leftv, rightv;
MX=random(90,WIDTH-90);
MY=random(84,120);
randr=random(30,80);
opp=random(400,600);
leftv=random(100,opp-100);
rightv=random(opp+100,900);

PX[0]=coox(MX,MY,randr,0);
PY[0]=cooy(MX,MY,randr,0);
PX_OLD[0]=PX[0]+(random(-150,150)/10);
PY_OLD[0]=PY[0]+(random(-150,150)/10);

PX[3]=coox(MX,MY,randr,opp);
PY[3]=cooy(MX,MY,randr,opp);
PX_OLD[3]=PX[3]+(random(-50,50)/10);
PY_OLD[3]=PY[3]+(random(-50,50)/10);

PX[1]=coox(MX,MY,randr,leftv);
PY[1]=cooy(MX,MY,randr,leftv);
PX_OLD[1]=PX[1]+(random(-50,50)/10);
PY_OLD[1]=PY[1]+(random(-50,50)/10);

PX[2]=coox(MX,MY,randr,rightv);
PY[2]=cooy(MX,MY,randr,rightv);
PX_OLD[2]=PX[2]+(random(-50,50)/10);
PY_OLD[2]=PY[2]+(random(-50,50)/10);


}


float calclength(int p1, int p2) {
float dx2,dy2;
dx2=pow(PX[p1]-PX[p2],2);
dy2=pow(PY[p1]-PY[p2],2);
return sqrt(dx2+dy2);
}

void renderbuttons() {
  textSize(16);
  textAlign(CENTER, CENTER);
  stroke(164,164,164);
  String label;
  
  if(RUNNING) {fill(128,110,0); label="RESET";} else {fill(100,100,100); label="Start";}
  rect(0,510,100,30,4);
  fill(255);
  text(label,50,525);
  

}

void mouseClicked() {
 if ( mouseY>=510 && mouseY<=540 && mouseX>0 && mouseX<100) {RUNNING=!RUNNING; if(!RUNNING) {reset();}}

}

void nickmouse() {


  if (mouseX<WIDTH && mouseY<HEIGHT) { //are we in range
    float dist;
  
    for(int i=0;i<N;i++)
     {
       dist=sqrt(((mouseX-PX[i])*(mouseX-PX[i]))+((mouseY-PY[i])*(mouseY-PY[i])));
       if (dist<=30) {
       //  noFill();
       //  stroke(255);
       // ellipse(PX[i],PY[i],10,10);
        PX[i]=mouseX;PY[i]=mouseY;
        PX_OLD[i]=PX[i];PY_OLD[i]=PY[i];
        break;
       } 
   
     }
  }
} 




float coox(float cx, float cy, float r, float t) {
// calculate x coordinate of point on circle t/1000 of 2PI around
return cx+(r*sin(t*TWO_PI/1000));
}

float cooy(float cx, float cy, float r, float t) {
// calculate x coordinate of point on circle t/1000 of 2PI around
return cy+(r*cos(t*TWO_PI/1000));
}