import processing.serial.*;
Serial myPort;  // Create object from Serial class

class MyObject{
  float dim = 30;            //size of the object
  float x,y,z;               //position coordinates
  float ax,ay,az;            //rotational values
  float sx=1, sy=1, sz=1;    //scaling factors
  boolean picked = false;    //picked status
  color c_face = color(20);  //color of face
  color c_edge = color(255);   // color of edge
  // translation
  void move3(float xin, float yin, float zin){
    x = xin;
    y = yin;
    z = zin;
    }
  // three rotations
  void rotate3 (float axin, float ayin, float azin){
  x = axin;
  y = ayin;
  z = azin;
  }
  // scaling
  void scale3 (float sxin, float syin, float szin){
  x = sxin;
  y = syin;
  z = szin;
  }
  // determine if an object is selected
  void pick (float xp, float yp){
  if (dist(xp,yp,screenX(x,y,z),screenY(x,y,z))<20)
    picked = true;
  else
    picked = false;
  }
  // draw the object
  void draw3(){
    stroke(c_edge);
    if (picked==true){
    fill (255,0,0);    
    }
    else 
    fill (c_face);
    pushMatrix();
    translate(x,y,z);
    rotateX(ax);
    rotateY(ay);
    rotateZ(az);
    scale(sx,sy,sz);
    box(dim);
    popMatrix();
  }
 }
// ********************************************************************
MyObject [] b;

int zoom;
void setup(){
  size(600,500,P3D);
  b = new MyObject[20];
  for (int i = 0; i<b.length; i++)
  b[i] = new MyObject ();
    
  String portName = Serial.list()[0]; //change the 0 to a 1 or 2 etc. to match your port
  myPort = new Serial(this, portName, 115200);
}

void draw(){
  background(0);
  camera(xd, yd, -100, b[12].x, b[12].y, b[12].z, 0,0,1);
  int k = 0;
  for (int x = 0; x<4; x++)
    for (int y = 0; y<5; y++){
      b[k].draw3();
      b[k].move3(x*60,y*60,0);
      k++;
    }
  }

  void mousePressed(){
    for (int i = 0; i<b.length; i++)
    b[i].pick(mouseX,mouseY);
    int pos=0;
    boolean selected = true;; //Boolean variable to locate selected array element
    for(int j=0;j<b.length;j++)
    {
    if(b[j].picked==selected)
    {
    pos=j;
    println(pos); //print to screen
    myPort.write(pos); //write to serial
  }
 }
}
    
float xd, yd;
void mouseDragged(){
  xd+= mouseX-pmouseX;
  yd+= mouseY-pmouseY;
  camera (xd, yd, 100+(zoom*5), b[11].x, b[11].y, b[11].z, 0,0,1);
}