//
//  toyball.js
//  examples
//
//  Created by Brad Hefta-Gaub on 1/20/14.
//  Copyright 2014 High Fidelity, Inc.
//
//  This is an example script that turns the hydra controllers into a toy ball catch and throw game.
//  It reads the controller, watches for button presses and trigger pulls, and launches entities.
//
//  The entities it creates have a script that when they collide with Voxels, the
//  entity will change it's color to match the voxel it hits.
//
//  Distributed under the Apache License, Version 2.0.
//  See the accompanying file LICENSE or http://www.apache.org/licenses/LICENSE-2.0.html
//

HIFI_PUBLIC_BUCKET = "http://s3.amazonaws.com/hifi-public/";

// maybe we should make these constants...
var LEFT_PALM = 0;
var RIGHT_PALM = 2;

var BALL_RADIUS = 0.08;
var GRAVITY_STRENGTH = 3.0;

var HELD_COLOR = { red: 240, green: 0, blue: 0 };
var THROWN_COLOR = { red: 128, green: 0, blue: 0 };

var averageLinearVelocity = [ { x: 0, y: 0, z : 0 }, { x: 0, y: 0, z : 0 } ];

var LIFETIME_SECONDS = 600;

var BALL_MODEL_URL = "https://hifi-public.s3.amazonaws.com/ryan/baseball4.fbx";

var leftBallAlreadyInHand = false;
var rightBallAlreadyInHand = false;
var leftHandEntity = false;
var rightHandEntity = false;

var newSound = SoundCache.getSound("https://dl.dropboxusercontent.com/u/1864924/hifi-sounds/throw.raw");
var catchSound = SoundCache.getSound("https://dl.dropboxusercontent.com/u/1864924/hifi-sounds/catch.raw");
var throwSound = SoundCache.getSound(HIFI_PUBLIC_BUCKET + "sounds/Switches%20and%20sliders/slider%20-%20whoosh1.raw");
var targetRadius = 0.25;


var wantDebugging = false;
function debugPrint(message) {
    if (wantDebugging) {
        print(message);
    }
}

function getBallHoldPosition(whichSide) { 
    if (whichSide == LEFT_PALM) {
        position = MyAvatar.getLeftPalmPosition();
    } else {
        position = MyAvatar.getRightPalmPosition();
    }
    
    return position;
}

function checkControllerSide(whichSide) {
    var palmPosition;
    var palmRotation;
    var ballAlreadyInHand;
    var handMessage;
    var linearVelocity;
    var angularVelocity; 
    var AVERAGE_FACTOR = 0.33;
    var grabButtonPressed;
	
    if (whichSide == LEFT_PALM) {
        palmPosition = MyAvatar.leftHandPose.translation;
        palmRotation = MyAvatar.leftHandPose.rotation;
        ballAlreadyInHand = leftBallAlreadyInHand;
        handMessage = "LEFT";
        averageLinearVelocity[0] = Vec3.sum(Vec3.multiply(AVERAGE_FACTOR, MyAvatar.leftHandTipPose.velocity), 
                                            Vec3.multiply(1.0 - AVERAGE_FACTOR, averageLinearVelocity[0]));

        linearVelocity = averageLinearVelocity[0];
        angularVelocity = MyAvatar.leftHandTipPose.angularVelocity;
        grabButtonPressed = (Controller.getValue(Controller.Standard.LT) > 0.5);
    
    } else {
        palmPosition = MyAvatar.rightHandPose.translation;
        palmRotation = MyAvatar.rightHandPose.rotation;
        ballAlreadyInHand = rightBallAlreadyInHand;
        averageLinearVelocity[1] = Vec3.sum(Vec3.multiply(AVERAGE_FACTOR, MyAvatar.rightHandTipPose.velocity), 
                                            Vec3.multiply(1.0 - AVERAGE_FACTOR, averageLinearVelocity[1]));
 
        linearVelocity = averageLinearVelocity[1];
        angularVelocity = MyAvatar.rightHandTipPose.angularVelocity;
        handMessage = "RIGHT";
        grabButtonPressed = (Controller.getValue(Controller.Standard.RT) > 0.5);
    
    }

    
    // If I don't currently have a ball in my hand, then try to catch closest one
    if (!ballAlreadyInHand && grabButtonPressed) {
        var closestEntity = Entities.findClosestEntity(palmPosition, targetRadius);

        if (closestEntity) {
            var foundProperties = Entities.getEntityProperties(closestEntity);
            if (Vec3.length(foundProperties.velocity) > 0.0) {

                debugPrint(handMessage + " - Catching a moving object!");

                if (whichSide == LEFT_PALM) {
                    leftBallAlreadyInHand = true;
                    leftHandEntity = closestEntity;
                } else {
                    rightBallAlreadyInHand = true;
                    rightHandEntity = closestEntity;
                }
                var ballPosition = getBallHoldPosition(whichSide);
                var properties = { position: { x: ballPosition.x, 
                                               y: ballPosition.y, 
                                               z: ballPosition.z },
                                    rotation: palmRotation,
                                    color: HELD_COLOR, 
                                    velocity : { x: 0, y: 0, z: 0}, 
                                    gravity: { x: 0, y: 0, z: 0}
                                    };
                Entities.editEntity(closestEntity, properties);
                
                Audio.playSound(catchSound, { position: ballPosition });
                
                return; // exit early
            }
        }
    }

    // change ball color logic...
    //
    //if (wasButtonJustPressed()) {
    //    rotateColor();
    //}

    //  If '3' is pressed, and not holding a ball, make a new one
    if (grabButtonPressed && !ballAlreadyInHand) {
        var ballPosition = getBallHoldPosition(whichSide);
        var properties = { 
                type: "Model",
                modelURL: BALL_MODEL_URL,
                position: { x: ballPosition.x, 
                            y: ballPosition.y, 
                            z: ballPosition.z },
                rotation: palmRotation, 
                velocity: { x: 0, y: 0, z: 0}, 
                gravity: { x: 0, y: 0, z: 0}, 
                dimensions: { x: BALL_RADIUS * 2, y: BALL_RADIUS * 2, z: BALL_RADIUS * 2 },
                damping: 0.00001,
                shapeType: "sphere",
                dynamic: false,
                color: HELD_COLOR,
                lifetime: LIFETIME_SECONDS
            };

        newEntity = Entities.addEntity(properties);
        if (whichSide == LEFT_PALM) {
            leftBallAlreadyInHand = true;
            leftHandEntity = newEntity;
        } else {
            rightBallAlreadyInHand = true;
            rightHandEntity = newEntity;
        }

        // Play a new ball sound
        Audio.playSound(newSound, { position: ballPosition});
        
        return; // exit early
    }

    if (ballAlreadyInHand) {
        if (whichSide == LEFT_PALM) {
            handEntity = leftHandEntity;
        } else {
            handEntity = rightHandEntity;
        }

        //  If holding the ball keep it in the palm
        if (grabButtonPressed) {
            debugPrint(">>>>> " + handMessage + "-BALL IN HAND, grabbing, hold and move");
            var ballPosition = getBallHoldPosition(whichSide);
            var properties = { position: { x: ballPosition.x, 
                                           y: ballPosition.y, 
                                           z: ballPosition.z }, 
                                rotation: palmRotation,
                                velocity: { x: 0, y: 0, z: 0}, 
                                gravity: { x: 0, y: 0, z: 0}, 
                };
            Entities.editEntity(handEntity, properties);
        } else {
            debugPrint(">>>>> " + handMessage + "-BALL IN HAND, not grabbing, THROW!!!");
            //  If toy ball just released, add velocity to it!
            var properties = { 
                    velocity: linearVelocity,
                    rotation: palmRotation,
                    angularVelocity: angularVelocity,
                    dynamic: true,
                    color: THROWN_COLOR,
                    gravity: { x: 0, y: -GRAVITY_STRENGTH, z: 0}, 
                };

            Entities.editEntity(handEntity, properties);

            if (whichSide == LEFT_PALM) {
                leftBallAlreadyInHand = false;
                leftHandEntity = false;
            } else {
                rightBallAlreadyInHand = false;
                rightHandEntity = false;
            }

            Audio.playSound(throwSound, { position: ballPosition });
        }
    }
}
function checkController(deltaTime) {

   checkControllerSide(LEFT_PALM);
   checkControllerSide(RIGHT_PALM);
}


// register the call back so it fires before each data send
Script.update.connect(checkController);