void setup(){
size(500,500);
smooth();
background(255);

frameRate(60);
}
float phi=0;
float psi=0;
float theta=0;
float alpha=0;
int mode=-1;
float t=0;
void tooth(float a,float r, float b, float w){
beginShape();
vertex(a*cos(w*-0.5),a*sin(w*-0.5));
vertex(a*cos(w*-0.28),a*sin(w*-0.28));
vertex(r*cos(w*-0.24),r*sin(w*-0.24));
vertex(b*cos(w*-0.12),b*sin(w*-0.12));
vertex(b*cos(w*+0.12),b*sin(w*+0.12));
vertex(r*cos(w*+0.24),r*sin(w*+0.24));
vertex(a*cos(w*+0.28),a*sin(w*+0.28));
vertex(a*cos(w*+0.5),a*sin(w*+0.5));
endShape();}

void gear(int t, int r, int p, int h){
float w=2*PI/t;
float a=r-h;
float b=r+h;
pushMatrix();
rotate(p*w*0.5);
for(int i=0;i<t;i++){tooth(a,r,b,w);rotate(w);}
popMatrix();
}
void draw(){

translate(250,250);
fill(255,0,0);
  rect(-230,205,25,25);
  fill(0,255,0);
  rect(-180,205,25,25);
  fill(255,166,0);
  rect(155,205,25,25);
  fill(0,0,255);
  rect(205,205,25,25);
  fill(255);
pushMatrix(); //draw innergear
rotate(phi);
fill(255);noStroke();
ellipse(0,0,430,430);
stroke(0);

gear(30,100,0,5);

ellipse(0,0,20,20); //draw center hole
line(0,0,100,0);
fill(255,0,0);
ellipse(100,0,10,10);
fill(255);
popMatrix();
pushMatrix(); //draw outer gear
rotate(psi);
gear(60,200,1,-5);
line(0,0,200,0);
fill(0,255,0);
ellipse(200,0,10,10);
fill(255);
noFill();
ellipse(0,0,430,430); //draw outer ring
popMatrix();
theta=phi/3+psi/1.5;
alpha=(phi-psi)*4/3;

pushMatrix(); //draw planetary gear
rotate(theta);
line(0,0,150,0);
pushMatrix();
translate(150,0);
rotate(-alpha);
gear(15,50,0,5);
line(0,0,50,0);
ellipse(0,0,20,20);
fill(255,0,0);
ellipse(-50,0,10,10);
fill(0,255,0);
ellipse(50,0,10,10);
fill(0,0,255);
ellipse(0,0,10,10);
fill(255);
popMatrix();
rotate(2*PI/3);
pushMatrix();
translate(150,0);
rotate(-alpha);
gear(15,50,0,5);
ellipse(0,0,20,20);

popMatrix();
rotate(2*PI/3);
pushMatrix();
translate(150,0);
rotate(-alpha);
gear(15,50,0,5);
ellipse(0,0,20,20);
popMatrix();
popMatrix();
if(mode==0){t+=1;phi=-PI*t/128;if(t>128*6){noLoop();}}
if(mode==1){t+=1;psi=-PI*t/192;if(t>192*6){noLoop();}}
if(mode==2){t+=1;
if(t<=128){phi=-PI*t/256;}
if(128<t && t<=128*3){psi=-PI*(t-128)/256;}
if(128*3<t && t<=128*5){phi=-PI*(t-256)/256;}
if(128*5<t && t<=128*7){psi=-PI*(t-384)/256;}
if(128*7<t && t<=128*8){phi=-PI*(t-512)/256;}
if(128*t<t){noLoop();t=0;phi=0;psi=0;}}
if(mode==3){t+=1;phi=-PI*sin(PI*t/512);psi=-PI*sin(PI*t/1024);
if(t>2048){noLoop();}}
}

 void mousePressed(){
   int x=mouseX; int y=mouseY;
   mode=-1;theta=0;phi=0;psi=0;t=0;
if(20<=x && x<=45 && 455 <=y && y <= 480){mode=0;loop();}
if(70<=x && x<=95 && 455 <=y && y <= 480){mode=1;loop();}
if(405<=x && x<=430 && 455 <=y && y <= 480){mode=2;loop();}
if(455<=x && x<=480 && 455 <=y && y <= 480){mode=3;loop();}
println("mode="+mode);}