Mimi Yin NYU-ITP

Controlling angle speed with speed of joint movement.

*/

​

// IP Address

let IP = "localhost";

​

// Scale size of skeleton

let SCL = 0.5;

​

// Declare kinectron

let kinectron = null;

​

// Keep track of selected joint

let j;

​

// Store current and previous positions of selected joint

let pos, ppos;

​

// Variables for circle

let a = 0;

​

// Directory of joints

let jointNames = [

  "PELVIS",

  "SPINE_NAVAL",

  "SPINE_CHEST",

  "NECK",

  "CLAVICLE_LEFT",

  "SHOULDER_LEFT",

  "ELBOW_LEFT",

  "WRIST_LEFT",

  "HAND_LEFT",

  "HANDTIP_LEFT",

  "THUMB_LEFT",

  "CLAVICLE_RIGHT",

  "SHOULDER_RIGHT",

  "ELBOW_RIGHT",

  "WRIST_RIGHT",

  "HAND_RIGHT",

  "HANDTIP_RIGHT",

  "THUMB_RIGHT",

  "HIP_LEFT",

  "KNEE_LEFT",

  "ANKLE_LEFT",

  "FOOT_LEFT",

  "HIP_RIGHT",

  "KNEE_RIGHT",

  "ANKLE_RIGHT",

  "FOOT_RIGHT",

  "HEAD",

  "NOSE",

  "EYE_LEFT",

  "EAR_LEFT",

  "EYE_RIGHT",

  "EAR_RIGHT"

];

​

// Joint indices by name

let PELVIS = 0;

let SPINE_NAVAL = 1;

let SPINE_CHEST = 2;

let NECK = 3;

let CLAVICLE_LEFT = 4;

let SHOULDER_LEFT = 5;

let ELBOW_LEFT= 6;

let WRIST_LEFT= 7;

let HAND_LEFT = 8;

let HANDTIP_LEFT = 9;

let THUMB_LEFT = 10;

let CLAVICLE_RIGHT = 11;

let SHOULDER_RIGHT = 12;

let ELBOW_RIGHT = 13;

let WRIST_RIGHT = 14;

let HAND_RIGHT = 15;

let HANDTIP_RIGHT = 16;

let THUMB_RIGHT = 17;

let HIP_LEFT = 18;

let KNEE_LEFT = 19;

let ANKLE_LEFT = 20;

let FOOT_LEFT = 21;

let HIP_RIGHT = 22;

let KNEE_RIGHT = 23;

let ANKLE_RIGHT = 24;

let FOOT_RIGHT = 25;

let HEAD = 26;

let NOSE = 27;

let EYE_LEFT = 28;

let EAR_LEFT = 29;

let EYE_RIGHT = 30;

let EAR_RIGHT = 31;

​

function setup() {

  createCanvas(windowWidth, windowHeight);

​

  // Define and create an instance of kinectron

  kinectron = new Kinectron(IP);

​

  // For Azure Kinect use "azure"

  kinectron.setKinectType("azure");

​

  // Connect with application over peer

  kinectron.makeConnection();

​

  // Request all tracked bodies and pass data to your callback

  kinectron.startTrackedBodies(bodyTracked);

​

  // Start drawing with left hand

  j = HAND_LEFT;

​

  // Draw white background

  background(0);

}

​

function draw() {}

​

function bodyTracked(body) {

  // Get the left hand joint

  let joint = body.skeleton.joints[j];

​

  // Calculate its x,y,z coordinates

  pos = scaleJoint(joint);

​

  // If there is a previous position

  if (ppos) {

    let speed = dist(ppos.x, ppos.y, ppos.z, pos.x, pos.y, pos.z);

​

    // Map the distance to angle speed

    let aspeed = map(speed, 0, width, 0, PI/2);

    // Inverse, non-linear mapping

    //let aspeed = 1/speed;

​

    a+=aspeed;

    background(0, 5);

    noStroke();

    // Calculate circular pathway

    let x = cos(a)*width/4 + width/2;

    let y = sin(a)*width/4 + height/2;

    ellipse(x, y, 5, 5);

  }

​

  // Store current location for next frame

  ppos = pos;

​

  // Print which joint is selected

  stroke(255);

  textSize(18);

  text("RT/LFT to change joints. " + j + ": " + jointNames[j], 10, 20);

}

​

// Draw each joint

function drawJoint(joint) {

  let pos = scaleJoint(joint);

  noStroke();

  fill(255);

  ellipse(pos.x, pos.y, 10, 10);

}

​

function keyPressed() {

  // Use RIGHT/LEFT arrow keys to change selected joint

  // ENTER to erase

  switch (keyCode) {

    case LEFT_ARROW:

      j--;

    case RIGHT_ARROW:

      j++;

      break;

    case ENTER:

      background(255);

      break;

  }

​

  // There are only 25 joints

  j = constrain(j, 0, 24);

}

​

// 0. Scale the joint position data to fit the screen

// 1. Move it to the center of the screen

// 2. Flip the x-value to mirror

// 3. Return it as an object literal

function scaleJoint(joint) {

  return {

    x: (-joint.cameraX * SCL) + width / 2,

    y: (joint.cameraY * SCL) + height / 2,

    z: (joint.cameraZ * SCL),

  }

}

​