overte-HifiExperiments/interface/src/AvatarTouch.cpp

//
//  AvatarTouch.cpp
//  interface
//
//  Created by Jeffrey Ventrella
//  Copyright (c) 2013 High Fidelity, Inc. All rights reserved.
//
#include <iostream>
#include <glm/glm.hpp>
#include <SharedUtil.h>
#include "AvatarTouch.h"
#include "InterfaceConfig.h"
#include "Util.h"

const float THREAD_RADIUS = 0.012;

AvatarTouch::AvatarTouch() {

    _myHandPosition     = glm::vec3(0.0f, 0.0f, 0.0f);
    _yourHandPosition   = glm::vec3(0.0f, 0.0f, 0.0f);
    _myBodyPosition     = glm::vec3(0.0f, 0.0f, 0.0f);
    _yourBodyPosition   = glm::vec3(0.0f, 0.0f, 0.0f);
    _vectorBetweenHands = glm::vec3(0.0f, 0.0f, 0.0f);
    _myHandState        = 0;
    _yourHandState      = 0;  
    _reachableRadius    = 0.0f;  
    
    _canReachToOtherAvatar   = false;
    _handsCloseEnoughToGrasp = false;

    for (int p=0; p<NUM_POINTS; p++) {
        _point[p] = glm::vec3(0.0, 0.0, 0.0);
    }
}

void AvatarTouch::setMyHandPosition(glm::vec3 position) {
    _myHandPosition = position;
}

void AvatarTouch::setYourHandPosition(glm::vec3 position) {
    _yourHandPosition = position;
}

void AvatarTouch::setMyBodyPosition(glm::vec3 position) {
    _myBodyPosition = position;
}

void AvatarTouch::setYourBodyPosition(glm::vec3 position) {
    _yourBodyPosition = position;
}

void AvatarTouch::setMyHandState(int state) {
    _myHandState = state;
}

void AvatarTouch::setYourHandState(int state) {
    _yourHandState = state;
}

void AvatarTouch::setReachableRadius(float r) {
    _reachableRadius = r;
}

void AvatarTouch::render(glm::vec3 cameraPosition) {

if (_canReachToOtherAvatar) {

        glColor4f(0.3, 0.4, 0.5, 0.5); 
        glm::vec3 p(_yourBodyPosition);
        p.y = 0.0005f;
        renderCircle(p, _reachableRadius, glm::vec3(0.0f, 1.0f, 0.0f), 30);

        renderBeamBetweenHands();

        // if your hand is grasping, show it...
        if (_yourHandState == 1) {
            glPushMatrix();
            glTranslatef(_yourHandPosition.x, _yourHandPosition.y, _yourHandPosition.z);
            glColor4f(1.0, 1.0, 0.8, 0.3); glutSolidSphere(0.020f, 10.0f, 10.0f);
            glColor4f(1.0, 1.0, 0.4, 0.2); glutSolidSphere(0.025f, 10.0f, 10.0f);
            glColor4f(1.0, 1.0, 0.2, 0.1); glutSolidSphere(0.030f, 10.0f, 10.0f);
            glPopMatrix();
        }
     }
    
    // if my hand is grasping, show it...
    if (_myHandState == 1) {
        glPushMatrix();
        glTranslatef(_myHandPosition.x, _myHandPosition.y, _myHandPosition.z);
        glColor4f(1.0, 1.0, 0.8, 0.3); glutSolidSphere(0.020f, 10.0f, 10.0f);
        glColor4f(1.0, 1.0, 0.4, 0.2); glutSolidSphere(0.025f, 10.0f, 10.0f);
        glColor4f(1.0, 1.0, 0.2, 0.1); glutSolidSphere(0.030f, 10.0f, 10.0f);
        glPopMatrix();
    }
}

void AvatarTouch::simulate (float deltaTime) {

    _vectorBetweenHands = _yourBodyPosition - _myBodyPosition;
    float distance = glm::length(_vectorBetweenHands);

    if (distance < _reachableRadius) {
        _canReachToOtherAvatar = true;
        generateBeamBetweenHands();
    } else {
        _canReachToOtherAvatar = false;
    }    
    
    
    
 }
 
void AvatarTouch::generateBeamBetweenHands() {

    for (int p=0; p<NUM_POINTS; p++) {
        _point[p] = _myHandPosition + _vectorBetweenHands * ((float)p / (float)NUM_POINTS);
        _point[p].x += randFloatInRange(-THREAD_RADIUS, THREAD_RADIUS);
        _point[p].y += randFloatInRange(-THREAD_RADIUS, THREAD_RADIUS);
        _point[p].z += randFloatInRange(-THREAD_RADIUS, THREAD_RADIUS);
    }
}




 
void AvatarTouch::renderBeamBetweenHands() {

    glm::vec3 v1(_myHandPosition);
    glm::vec3 v2(_yourHandPosition);

    glLineWidth(2.0);
    glColor4f(0.7f, 0.4f, 0.1f, 0.3);
    glBegin(GL_LINE_STRIP);
    glVertex3f(v1.x, v1.y, v1.z);
    glVertex3f(v2.x, v2.y, v2.z);
    glEnd();

    glColor4f(1.0f, 1.0f, 0.0f, 0.8);

    for (int p=0; p<NUM_POINTS; p++) {
        glBegin(GL_POINTS);
        glVertex3f(_point[p].x, _point[p].y, _point[p].z);
        glEnd();
    }    
}