boolean td=false;
boolean tl=false;
boolean tu=false;
boolean tr=false;
boolean w,a,s,d;
PVector loc = new PVector();
float x2=1600/2;
float y2=900/2;
float z2=0;
float camRotZ;
float camRotX = 75;
float frotZ,frotY;
float spd=10;

void setup(){
  size(1600,900,P3D);
  background(0);
  frameRate(30);
}

void draw(){
  moveCam();
  move();
  textSize(25);
  fill(255);
  stroke(255);
  background(0);
  pushMatrix();
    translate(x2,y2,z2);
    rotateX(radians(camRotX));
    rotateZ(radians(camRotZ));
    pushMatrix();
      rotateZ(radians(frotZ));
      translate(0,0,-150);
      fill(100,100,100);
      rectMode(RADIUS);
      rect(loc.x,loc.y,1000,1000);
    popMatrix();
    pushMatrix();
      noFill();
      stroke(200);
      sphere(25);
      line(0,0,0,-100);
    popMatrix();
  popMatrix();
  fill(255);
  stroke(255);
  text("x: "+loc.x+", y: "+loc.y+", z: "+loc.z+"\n"+"frotZ: "+frotZ+", to rad: "+radians(frotZ)+"\nsin(frotZ): "+sin(frotZ)+"\ncamRotZ: "+camRotZ+", camRotX: "+camRotX,20,40);
}

void mouseWheel(MouseEvent event) {
  float e = event.getCount();
  if(e != 0) {
    if(e < 0) {
      z2+=10;
    } else if(e > 0) {
      z2-=10;
    }
  }
}

void keyPressed(){
  if(key == 'a' || key == 'A'){
    a=true;
  } else if(key == 'd' || key == 'D'){
    d=true;
  } else if(key == 'w' || key == 'W'){
    w=true;
  } else if(key == 's' || key == 'S'){
    s=true;
  }
}

void keyReleased(){
  if(key == 'a' || key == 'A'){
    a=false;
  } else if(key == 'd' || key == 'D'){
    d=false;
  } else if(key == 'w' || key == 'W'){
    w=false;
  } else if(key == 's' || key == 'S'){
    s=false;
  }
}

void mouseDragged(){
  if(pmouseX>mouseX){
    tl=false;
    tr=true;
  } if(pmouseX<mouseX){
    tr=false;
    tl=true;
  } if(pmouseY>mouseY){
    tu=true;
    td=false;
  } if(pmouseY<mouseY){
    td=true;
    tu=false;
  }
}

void mouseReleased(){
  tr=false;
  tl=false;
  tu=false;
  td=false;
}

void moveCam(){
  //cam Z
  if(tl){
    if(camRotZ-((mouseX-pmouseX)/5)<0) { camRotZ+=360; }
    camRotZ+=(pmouseX-mouseX)/5;
  } else if(tr) {
    if(camRotZ+((pmouseX-mouseX)/5)>360) { camRotZ-=360; }
    camRotZ-=(mouseX-pmouseX)/5;
  }

  //cam X
  if(td){
    if(camRotX-((pmouseY-mouseY)/5)<=0) { camRotX+=360; }
    camRotX+=(pmouseY-mouseY)/5;
  } else if(tu){
    if(camRotX+((mouseY-pmouseY)/5)>=360) { camRotX-=360; }
    camRotX-=(mouseY-pmouseY)/5;
  }
}

void move(){
  if(w){
    loc.sub(spd * sin(radians(frotZ)), 0.0, spd * cos(radians(frotZ)));
  } if(s){
    loc.add(spd * sin(radians(frotZ)), 0.0, spd * cos(radians(frotZ)));
  }
  if(a){
    if(frotZ+1>360){
      frotZ=0;
    }
    frotZ+=1;
  } if(d){
    if(frotZ-1<0){
      frotZ=360;
    }
    frotZ-=1;
  }
}