/*
 * Copyright (c) Erin Catto
 * Licensed under the MIT license
 */

import { World, Transform, Box, Distance, Testbed } from "planck";

const DistanceInput = Distance.Input;
const DistanceOutput = Distance.Output;
const SimplexCache = Distance.Cache;

const world = new World();

const testbed = Testbed.mount();
testbed.start(world);

const transformA = new Transform({ x: 0.0, y: -0.2 });

const polygonA = new Box(10.0, 0.2);

const positionB = { x: 12.017401, y: 0.13678508 };
let angleB = -0.0109265;
const transformB = new Transform(positionB, angleB);

const polygonB = new Box(2.0, 0.1);

const bodyA = world.createBody({
  type: "static",
});
const fixA = bodyA.createFixture({
  shape: polygonA,
});

const bodyB = world.createBody({
  type: "static",
});
const fixB = bodyB.createFixture({
  shape: polygonB,
});

testbed.step = function () {
  const input = new DistanceInput();
  input.proxyA.set(polygonA, 0);
  input.proxyB.set(polygonB, 0);
  input.transformA.set(transformA);
  input.transformB.set(transformB);
  input.useRadii = true;

  const cache = new SimplexCache();

  const output = new DistanceOutput();

  Distance(output, cache, input);

  testbed.status("Distance", output.distance);
  testbed.status("Iterations", output.iterations);

  bodyA.setTransform(transformA);
  bodyB.setTransform(transformB);

  const x1 = output.pointA;
  const x2 = output.pointB;

  testbed.drawPoint(x1, 4.0, testbed.color(1.0, 0.0, 0.0));
  testbed.drawPoint(x2, 4.0, testbed.color(1.0, 1.0, 0.0));
};

testbed.keydown = function () {
  if (testbed.activeKeys["left"]) {
    positionB.x -= 0.1;
  }

  if (testbed.activeKeys["right"]) {
    positionB.x += 0.1;
  }

  if (testbed.activeKeys["down"]) {
    positionB.y -= 0.1;
  }

  if (testbed.activeKeys["up"]) {
    positionB.y += 0.1;
  }

  if (testbed.activeKeys["Z"]) {
    angleB += 0.1;
  }

  if (testbed.activeKeys["X"]) {
    angleB -= 0.1;
  }

  transformB.set(positionB, angleB);
};