Merge pull request #6390 from sethalves/average-near-holds

Average near holds

interface/src/avatar/AvatarActionHold.cpp

@@ -10,7 +10,6 @@
 //
 
 #include "QVariantGLM.h"
-#include "avatar/MyAvatar.h"
 #include "avatar/AvatarManager.h"
 
 #include "AvatarActionHold.h"
@@ -22,8 +21,7 @@ AvatarActionHold::AvatarActionHold(const QUuid& id, EntityItemPointer ownerEntit
     _relativePosition(glm::vec3(0.0f)),
     _relativeRotation(glm::quat()),
     _hand("right"),
-    _holderID(QUuid())
-{
+    _holderID(QUuid()) {
     _type = ACTION_TYPE_HOLD;
     #if WANT_DEBUG
     qDebug() << "AvatarActionHold::AvatarActionHold";
@@ -36,13 +34,10 @@ AvatarActionHold::~AvatarActionHold() {
     #endif
 }
 
-void AvatarActionHold::updateActionWorker(float deltaTimeStep) {
-    bool gotLock = false;
-    glm::quat rotation;
-    glm::vec3 position;
+std::shared_ptr<Avatar> AvatarActionHold::getTarget(glm::quat& rotation, glm::vec3& position) {
     std::shared_ptr<Avatar> holdingAvatar = nullptr;
 
-    gotLock = withTryReadLock([&]{
+    withTryReadLock([&]{
         QSharedPointer<AvatarManager> avatarManager = DependencyManager::get<AvatarManager>();
         AvatarSharedPointer holdingAvatarData = avatarManager->getAvatarBySessionID(_holderID);
         holdingAvatar = std::static_pointer_cast<Avatar>(holdingAvatarData);
@@ -65,22 +60,53 @@ void AvatarActionHold::updateActionWorker(float deltaTimeStep) {
         }
     });
 
-    if (holdingAvatar) {
+    return holdingAvatar;
+}
+
+void AvatarActionHold::updateActionWorker(float deltaTimeStep) {
+    glm::quat rotation;
+    glm::vec3 position;
+    bool valid = false;
+    int holdCount = 0;
+
+    auto ownerEntity = _ownerEntity.lock();
+    if (!ownerEntity) {
+        return;
+    }
+    QList<EntityActionPointer> holdActions = ownerEntity->getActionsOfType(ACTION_TYPE_HOLD);
+    foreach (EntityActionPointer action, holdActions) {
+        std::shared_ptr<AvatarActionHold> holdAction = std::static_pointer_cast<AvatarActionHold>(action);
+        glm::quat rotationForAction;
+        glm::vec3 positionForAction;
+        std::shared_ptr<Avatar> holdingAvatar = holdAction->getTarget(rotationForAction, positionForAction);
+        if (holdingAvatar) {
+            holdCount ++;
+            if (holdAction.get() == this) {
+                // only use the rotation for this action
+                valid = true;
+                rotation = rotationForAction;
+            }
+
+            position += positionForAction;
+        }
+    }
+
+    if (valid && holdCount > 0) {
+        position /= holdCount;
+
+        bool gotLock = withTryWriteLock([&]{
+            _positionalTarget = position;
+            _rotationalTarget = rotation;
+            _positionalTargetSet = true;
+            _rotationalTargetSet = true;
+            _active = true;
+        });
         if (gotLock) {
-            gotLock = withTryWriteLock([&]{
-                _positionalTarget = position;
-                _rotationalTarget = rotation;
-                _positionalTargetSet = true;
-                _rotationalTargetSet = true;
-                _active = true;
-            });
-            if (gotLock) {
-                if (_kinematic) {
-                    doKinematicUpdate(deltaTimeStep);
-                } else {
-                    activateBody();
-                    ObjectActionSpring::updateActionWorker(deltaTimeStep);
-                }
+            if (_kinematic) {
+                doKinematicUpdate(deltaTimeStep);
+            } else {
+                activateBody();
+                ObjectActionSpring::updateActionWorker(deltaTimeStep);
             }
         }
     }
@@ -109,7 +135,8 @@ void AvatarActionHold::doKinematicUpdate(float deltaTimeStep) {
             if (_previousSet) {
                 // smooth velocity over 2 frames
                 glm::vec3 positionalDelta = _positionalTarget - _previousPositionalTarget;
-                glm::vec3 positionalVelocity = (positionalDelta + _previousPositionalDelta) / (deltaTimeStep + _previousDeltaTimeStep);
+                glm::vec3 positionalVelocity =
+                    (positionalDelta + _previousPositionalDelta) / (deltaTimeStep + _previousDeltaTimeStep);
                 rigidBody->setLinearVelocity(glmToBullet(positionalVelocity));
                 _previousPositionalDelta = positionalDelta;
                 _previousDeltaTimeStep = deltaTimeStep;

interface/src/avatar/AvatarActionHold.h

@@ -17,6 +17,9 @@
 #include <EntityItem.h>
 #include <ObjectActionSpring.h>
 
+#include "avatar/MyAvatar.h"
+
+
 class AvatarActionHold : public ObjectActionSpring {
 public:
     AvatarActionHold(const QUuid& id, EntityItemPointer ownerEntity);
@@ -32,6 +35,8 @@ public:
 
     virtual bool shouldSuppressLocationEdits() { return _active && !_ownerEntity.expired(); }
 
+    std::shared_ptr<Avatar> getTarget(glm::quat& rotation, glm::vec3& position);
+
 private:
     static const uint16_t holdVersion;
 

libraries/entities/src/EntityActionInterface.h

@@ -12,11 +12,14 @@
 #ifndef hifi_EntityActionInterface_h
 #define hifi_EntityActionInterface_h
 
+#include <memory>
 #include <QUuid>
+#include <glm/glm.hpp>
 
-#include "EntityItem.h"
-
+class EntityItem;
 class EntitySimulation;
+using EntityItemPointer = std::shared_ptr<EntityItem>;
+using EntityItemWeakPointer = std::weak_ptr<EntityItem>;
 
 enum EntityActionType {
     // keep these synchronized with actionTypeFromString and actionTypeToString
@@ -34,6 +37,8 @@ public:
     const QUuid& getID() const { return _id; }
     EntityActionType getType() const { return _type; }
 
+    bool isActive() { return _active; }
+
     virtual void removeFromSimulation(EntitySimulation* simulation) const = 0;
     virtual EntityItemWeakPointer getOwnerEntity() const = 0;
     virtual void setOwnerEntity(const EntityItemPointer ownerEntity) = 0;
@@ -81,6 +86,7 @@ protected:
 
     QUuid _id;
     EntityActionType _type;
+    bool _active { false };
 };
 
 

libraries/entities/src/EntityItem.cpp

@@ -1844,3 +1844,18 @@ bool EntityItem::shouldSuppressLocationEdits() const {
 
     return false;
 }
+
+QList<EntityActionPointer> EntityItem::getActionsOfType(EntityActionType typeToGet) {
+    QList<EntityActionPointer> result;
+
+    QHash<QUuid, EntityActionPointer>::const_iterator i = _objectActions.begin();
+    while (i != _objectActions.end()) {
+        EntityActionPointer action = i.value();
+        if (action->getType() == typeToGet && action->isActive()) {
+            result += action;
+        }
+        i++;
+    }
+
+    return result;
+}

libraries/entities/src/EntityItem.h

@@ -30,6 +30,7 @@
 #include "EntityTypes.h"
 #include "SimulationOwner.h"
 #include "SimulationFlags.h"
+#include "EntityActionInterface.h"
 
 class EntitySimulation;
 class EntityTreeElement;
@@ -419,7 +420,9 @@ public:
 
     void setSourceUUID(const QUuid& sourceUUID) { _sourceUUID = sourceUUID; }
     const QUuid& getSourceUUID() const { return _sourceUUID; }
-    bool matchesSourceUUID(const QUuid& sourceUUID) const  { return _sourceUUID == sourceUUID; }
+    bool matchesSourceUUID(const QUuid& sourceUUID) const { return _sourceUUID == sourceUUID; }
+
+    QList<EntityActionPointer> getActionsOfType(EntityActionType typeToGet);
 
 protected:
 

libraries/entities/src/EntityTypes.h

@@ -20,8 +20,8 @@
 #include <OctreeRenderer.h> // for RenderArgs
 
 class EntityItem;
-typedef std::shared_ptr<EntityItem> EntityItemPointer;
-typedef std::weak_ptr<EntityItem> EntityItemWeakPointer;
+using EntityItemPointer = std::shared_ptr<EntityItem>;
+using EntityItemWeakPointer = std::weak_ptr<EntityItem>;
 
 inline uint qHash(const EntityItemPointer& a, uint seed) {
     return qHash(a.get(), seed);

libraries/physics/src/ObjectAction.h

@@ -67,7 +67,6 @@ protected:
     EntityItemWeakPointer _ownerEntity;
     QString _tag;
     quint64 _expires { 0 }; // in seconds since epoch
-    bool _active { false };
 
 private:
     int getEntityServerClockSkew() const;