//have to mention them here 

var rightHandX; //because they are shared between draw and trackBody

// var rightHandZ; // track Z for velocity

var rightElbowX;

var rightElbowY;

var rightShoulderX;

var rightShoulderY;

var leftHandX;

var leftHandZ; // track Z for velocity

var leftElbowX;

var leftElbowY;

var leftShoulderX;

var leftShoulderY;

var xNeck;

var yNeck;

var xSpineShoulder;

var ySpineShoulder;

var xpos = 0; // ellipse starting in center  /  of SCREEN

var ypos = 0; // ellipse starting in center  /  of SCREEN

var zHead; // head Z for up /down

var xHead; // head X for side/side

var zHip; // measured relative to head

var xHip; // measure head relative to hip for lean

​

// variables to track speed and average out values

var velocityValuesR = []

var velocityValuesL = []

​

var sumR;

var sumL

var avgSpeedR;

var avgSpeedL;

var avgSpeed;

​

// variables to track flapping speed

var prevRightHandY = 0;

var rightHandY = 0;

var rightHandSpeed = 0;

​

var leftHandY = 0;

var prevLeftHandY = 0;

var leftHandSpeed = 0;

​

// variables to track z position  /  might not be used

var rightHandZ = 0;

var rightHandSpeedZ = 0;

var Zdifference;

​

// variables to hold the constrained x & y pos to be written

var posY;

var posX;

​

// new variables to send to arduino for control

var xDiff = 0; 

var yDiff = 0;

​

// variables to hold intervals

var interval = 2000;

var delay = 200;

​

// variable to hold sending byte

var outByte = '';

​

// variable to dampen movement

var dampening = 0.1;

​

// variable to constrain mouse movement range

var barrier = 3;

​

​

function connectKinect() {

  console.log('inside connectKinect');

​

  var address = {

        host: '172.16.247.250',

        port: 9001,

        path: '/'

    };

 frameRate(30);

  kinectron = new Kinectron('kinectron', address);

    kinectron.makeConnection();

    kinectron.startMultiFrame(["body","joints"],bodyTracked);

    // kinectron.startMultiFrame(bodyTracked);

​

}

​

function bodyTracked(bodies) {

    // console.log('should be writing');

​

​

    var closestBody = getClosestBodyIndex(bodies.body);

    if (closestBody < 0) return

    var body = bodies.body[closestBody]

    // console.log('inside bodyTracked')

    // RIGHT

    // Hand

   // console.log(body.joints[kinectron.HANDRIGHT].depthX);

​

    var handRx = body.joints[kinectron.HANDRIGHT].depthX;

    rightHandX = map(handRx, 0, 1, 0, width);

    prevRightHandY = rightHandY;

    var handRy = body.joints[kinectron.HANDRIGHT].depthY;

    rightHandY = map(handRy, 0, 1, 0, height);

    rightHandSpeed = abs((0.5 * rightHandSpeed) + 0.5 * (rightHandY - prevRightHandY));

​

    prevRightHandZ = rightHandZ;

    var handRz = body.joints[kinectron.HANDRIGHT].cameraZ;

    rightHandZ = map(handRx, 0, 1, 0, 200);

​

    Zdifference = abs(prevRightHandZ - rightHandZ);

​

    // Elbow

    var elbowRx = body.joints[kinectron.ELBOWRIGHT].depthX;

    rightElbowX = map(elbowRx, 0, 1, 0, width);

    var elbowRy = body.joints[kinectron.ELBOWRIGHT].depthY;

    rightElbowY = map(elbowRy, 0, 1, 0, height); //height numbers bigger at the bottom

​

    // Shoulder

    var shoulderRx = body.joints[kinectron.SHOULDERRIGHT].depthX;

    rightShoulderX = map(shoulderRx, 0, 1, 0, width);

    var shoulderRy = body.joints[kinectron.SHOULDERRIGHT].depthY;

    rightShoulderY = map(shoulderRy, 0, 1, 0, height); //height numbers bigger at the bottom

​

    // LEFT

    // Hand

    var handLx = body.joints[kinectron.HANDLEFT].depthX;

    leftHandX = map(handLx, 0, 1, 0, width);

    var handLy = body.joints[kinectron.HANDLEFT].depthY;

    prevLeftHandY = leftHandY;

    leftHandY = map(handLy, 0, 1, 0, height); //height numbers bigger at the bottom

    leftHandSpeed = abs((0.5 * leftHandSpeed) + 0.5 * (leftHandY - prevLeftHandY));

​

    var handLz = body.joints[kinectron.HANDLEFT].cameraZ;

    leftHandZ = map(handLz, 0, 1, 0, 200);

​

    // Elbow

    var elbowLx = body.joints[kinectron.ELBOWLEFT].depthX;

    leftElbowX = map(elbowLx, 0, 1, 0, width);

    var elbowLy = body.joints[kinectron.ELBOWLEFT].depthY;

    leftElbowY = map(elbowLy, 0, 1, 0, height); //height numbers bigger at the bottom

​

    // Shoulder

    var shoulderLx = body.joints[kinectron.SHOULDERLEFT].depthX;

    leftShoulderX = map(shoulderLx, 0, 1, 0, width);

    var shoulderLy = body.joints[kinectron.SHOULDERLEFT].depthY;

    leftShoulderY = map(shoulderLy, 0, 1, 0, height); //height numbers bigger at the bottom

​

    // CENTER

    // Neck

    var neckX = body.joints[kinectron.NECK].depthX;

    xNeck = map(neckX, 0, 1, 0, width);

    var neckY = body.joints[kinectron.NECK].depthY;

    yNeck = map(neckY, 0, 1, 0, height); //height numbers bigger at the bottom

​

    // Spine Shoulder

    var spineShoulderX = body.joints[kinectron.SPINESHOULDER].depthX;

    xSpineShoulder = map(spineShoulderX, 0, 1, 0, width);

    var spineShoulderY = body.joints[kinectron.SPINESHOULDER].depthY;

    ySpineShoulder = map(spineShoulderY, 0, 1, 0, height); //height numbers bigger at the bottom

​

    // Head and Hips for move up/down & left/right

    var headZ = body.joints[kinectron.HEAD].cameraZ;

    zHead = map(headZ, 0, 1, 0, 200);

    var headX = body.joints[kinectron.HEAD].depthX;

    xHead = map(headX, 0, 1, 0, width);

    var hipZ = body.joints[kinectron.SPINEBASE].cameraZ;

    zHip = map(hipZ, 0, 1, 0, 200);

    var hipX = body.joints[kinectron.SPINEBASE].depthX;

    xHip = map(hipX, 0, 1, 0, width);

​

    // get X and Y values for mouse.move

    xDiff = int((xHead - xHip)/10); 

    yDiff = int((zHead - zHip)/10);

    // get Speed value for keyboard.write

    getSpeed();

  //  if (avgSpeed < 1){

  //   avgSpeedL = 10;

  //    avgSpeedR = 10;

  // }

    outByte = int(xDiff) + ', ' + int(yDiff) + ', ' + int(avgSpeed) + ';'

    serial.write(outByte + ';' + '\n');

  console.log(outByte);

  // console.log("should be writing");

}

​

​

function getClosestBodyIndex(bodies) {

      // console.log('inside getClosestBodyIndex')

​

    var closestZ = Number.MAX_VALUE;

    var closestBodyIndex = -1;

​

    for (var i = 0; i < bodies.length; i++) {

        if (bodies[i].tracked && bodies[i].joints[kinectron.SPINEMID].cameraZ < closestZ) {

            closestZ = bodies[i].joints[kinectron.SPINEMID].cameraZ;

            closestBodyIndex = i;

        }

    }

return closestBodyIndex;

}

​

​

function getSpeed() {

    velocityValuesR.push(rightHandSpeed)

    sumR = velocityValuesR.reduce(getSumR);

    avgSpeedR = sumR / velocityValuesR.length

    if (velocityValuesR.length > 20) {

        velocityValuesR.splice(0, 1)

    }

    velocityValuesL.push(leftHandSpeed)

    sumL = velocityValuesL.reduce(getSumL);

    avgSpeedL = sumL / velocityValuesL.length

    if (velocityValuesL.length > 20) {

        velocityValuesL.splice(0, 1)

    }

    avgSpeed = (avgSpeedL + avgSpeedR) * 2

  console.log(avgSpeedL);

    console.log(avgSpeedR);

​

}

​

function getSumR(total, num) {

    return total + num;

}

​

function getSumL(total, num) {

    return total + num;

}

​

​

​