let objects = [];

const sc = 100;

const stepSize = 0.05;

const turnSize = 0.05;

const fov = 0.8;

​

function setup() {

  createCanvas(600, 600);

  player = new Player(sc);

  world = new World(sc);

  objects.push(new WorldObject(sc, 0, 0, -1, 0.1));

  background(220);

}

​

function draw() {

  background(220, 50);

  world.show();

  player.show();

  for (let ni = 0; ni < objects.length; ni++) {

    objects[ni].show();

  }

  if (keyIsDown(87)) player.moveForw(stepSize); // w

  if (keyIsDown(83)) player.moveBack(stepSize); // s

  if (keyIsDown(65)) player.rotLeft(turnSize); // a

  if (keyIsDown(68)) player.rotRight(turnSize); // d  

​

  textSize(16);

  text("pos.x: " + (player.pos.x).toFixed(3), 20, 20);

  text("pos.y: " + (player.pos.y).toFixed(3), 20, 40);

  text("pos.z: " + (player.pos.z).toFixed(3), 20, 60);

​

  text("ori.x: " + (player.ori.x).toFixed(3), 20, height - 80 + 20);

  text("ori.y: " + (player.ori.y).toFixed(3), 20, height - 80 + 40);

  text("ori.z: " + (player.ori.z).toFixed(3), 20, height - 80 + 60);

​

  push();

  translate(3 * width / 4, 3 * height / 4);

  stroke(255, 0, 0);

  line(0, 0, player.pos.x * sc, player.pos.y * sc);

  stroke(0, 255, 0);

  line(0, 0, player.ori.x * sc, player.ori.y * sc);

  let tmp = p5.Vector.cross(player.pos, player.ori);

  stroke(0, 0, 255);

  line(0, 0, tmp.x * sc, tmp.y * sc);

  pop();

​

  text("Should be 1: " + tmp.mag().toFixed(2), width - 140, height - 40);

  text("Framerate (60): " + frameRate().toFixed(0), width - 160, height - 20);

​

  // Ray tracing section:

  const res = 100;

  objects.push(player);

  push();

  translate(0, 100);

  noStroke();

  let best = 0;

  for (let ni = 0; ni < res; ni++) {

    let theta = map(ni, 0, res - 1, -fov / 2, fov / 2);

    let pos = player.pos.copy();

    let ori = player.ori.copy();

    let left = p5.Vector.cross(pos, ori);

    let tmp = player.rotTowardVec(ori, left, theta);

    let direction = tmp[0].normalize();

    let col = 255 * (1 - player.rayMarch(player.pos.copy(), direction, objects, 0) / TWO_PI);

    if (col > best) best = col;

    fill(col);

    rect(ni * width / res, 0, width, 40);

  }

  pop();

  objects.pop();

  text((1 - best / 255) * TWO_PI, width - 200,20);

}