Fixed Blend2Node::UpdateFlags().

- Refactored NodeSocketAccessor to NodeDescriptor.
- Connections are wired up during AnimGraph instantiation.
  - Output and input sockets point to the same memory location.
  - No re-wiring needed during evaluation.
  - AnimGraph are pre-allocated (refactoring for less memory usage postponed).
- Evaluation of AnimGraph now possible from the editor.

src/AnimGraph/AnimGraph.cc

@@ -4,6 +4,7 @@
 
 #include "AnimGraph.h"
 
+#include <algorithm>
 #include <cstring>
 
 bool AnimGraph::init(AnimGraphContext& context) {
@@ -44,6 +45,17 @@ void AnimGraph::updateOrderedNodesRecursive(int node_index) {
   }
 
   if (node_index != 0) {
+    // In case we have multiple output connections from the node we here
+    // ensure that use the node evaluation that is the furthest away from
+    // the output.
+    std::vector<AnimNode*>::iterator find_iter = std::find(
+        m_eval_ordered_nodes.begin(),
+        m_eval_ordered_nodes.end(),
+        node);
+    if (find_iter != m_eval_ordered_nodes.end()) {
+      m_eval_ordered_nodes.erase(find_iter);
+    }
+
     m_eval_ordered_nodes.push_back(node);
   }
 }
@@ -85,71 +97,6 @@ void AnimGraph::markActiveNodes() {
   }
 }
 
-void AnimGraph::prepareNodeEval(
-    AnimGraphContext& graph_context,
-    size_t node_index) {
-  for (size_t i = 0, n = m_node_output_connections[node_index].size(); i < n;
-       i++) {
-    AnimGraphConnection& output_connection =
-        m_node_output_connections[node_index][i];
-    if (output_connection.m_source_socket.m_type
-        != SocketType::SocketTypeAnimation) {
-      continue;
-    }
-
-    // TODO: only allocate local matrices for active nodes
-  }
-
-  for (size_t i = 0, n = m_node_input_connections[node_index].size(); i < n;
-       i++) {
-    AnimGraphConnection& input_connection =
-        m_node_input_connections[node_index][i];
-    if (input_connection.m_source_socket.m_type
-        != SocketType::SocketTypeAnimation) {
-      continue;
-    }
-  }
-}
-
-void AnimGraph::finishNodeEval(size_t node_index) {
-  for (size_t i = 0, n = m_node_input_connections[node_index].size(); i < n;
-       i++) {
-    AnimGraphConnection& input_connection =
-        m_node_input_connections[node_index][i];
-    if (input_connection.m_source_socket.m_type
-        != SocketType::SocketTypeAnimation) {
-      continue;
-    }
-
-    // TODO: free local matrices for inactive nodes
-  }
-}
-
-void AnimGraph::evalInputNode() {
-  for (size_t i = 0, n = m_node_output_connections[1].size(); i < n; i++) {
-    AnimGraphConnection& graph_input_connection =
-        m_node_output_connections[1][i];
-
-    if (graph_input_connection.m_source_socket.m_type
-        != SocketType::SocketTypeAnimation) {
-      memcpy(
-          *graph_input_connection.m_target_socket.m_reference.ptr_ptr,
-          graph_input_connection.m_source_socket.m_reference.ptr,
-          sizeof(void*));
-      printf("bla");
-    } else {
-      // TODO: how to deal with anim data outputs?
-    }
-  }
-}
-
-void AnimGraph::evalOutputNode() {
-  for (size_t i = 0, n = m_node_input_connections[0].size(); i < n; i++) {
-    AnimGraphConnection& graph_output_connection =
-        m_node_input_connections[0][i];
-  }
-}
-
 void AnimGraph::evalSyncTracks() {
   for (size_t i = m_eval_ordered_nodes.size() - 1; i >= 0; i--) {
     AnimNode* node = m_eval_ordered_nodes[i];
@@ -206,15 +153,8 @@ void AnimGraph::evaluate(AnimGraphContext& context) {
       continue;
     }
 
-    prepareNodeEval(context, node->m_index);
-
     node->Evaluate(context);
-
-    finishNodeEval(node->m_index);
   }
-
-  evalOutputNode();
-  finishNodeEval(0);
 }
 
 Socket* AnimGraph::getInputSocket(const std::string& name) {

src/AnimGraph/AnimGraph.h

@@ -19,13 +19,14 @@ struct AnimGraph {
   std::vector<std::vector<AnimGraphConnection> > m_node_input_connections;
   std::vector<std::vector<AnimGraphConnection> > m_node_output_connections;
   std::vector<AnimData*> m_animdata_blocks;
-  NodeDescriptorBase* m_socket_accessor;
+  NodeDescriptorBase* m_node_descriptor;
   char* m_input_buffer = nullptr;
   char* m_output_buffer = nullptr;
   char* m_connection_data_storage = nullptr;
+  char* m_const_node_inputs = nullptr;
 
-  std::vector<Socket>& getGraphOutputs() { return m_socket_accessor->m_inputs; }
-  std::vector<Socket>& getGraphInputs() { return m_socket_accessor->m_outputs; }
+  std::vector<Socket>& getGraphOutputs() { return m_node_descriptor->m_inputs; }
+  std::vector<Socket>& getGraphInputs() { return m_node_descriptor->m_outputs; }
 
   AnimDataAllocator m_anim_data_allocator;
 
@@ -44,13 +45,14 @@ struct AnimGraph {
     delete[] m_input_buffer;
     delete[] m_output_buffer;
     delete[] m_connection_data_storage;
+    delete[] m_const_node_inputs;
 
     for (int i = 0; i < m_nodes.size(); i++) {
       delete m_nodes[i];
     }
     m_nodes.clear();
 
-    delete m_socket_accessor;
+    delete m_node_descriptor;
   }
 
   void updateOrderedNodes();
@@ -60,11 +62,6 @@ struct AnimGraph {
     return node->m_state != AnimNodeEvalState::Deactivated;
   }
 
-  void evalInputNode();
-  void prepareNodeEval(AnimGraphContext& graph_context, size_t node_index);
-  void finishNodeEval(size_t node_index);
-  void evalOutputNode();
-
   void evalSyncTracks();
   void updateTime(float dt);
   void evaluate(AnimGraphContext& context);
@@ -82,6 +79,91 @@ struct AnimGraph {
   const Socket* getInputSocket(const std::string& name) const;
   const Socket* getOutputSocket(const std::string& name) const;
 
+  /** Sets the address that is used for the specified AnimGraph input Socket.
+   *
+   * @tparam T Type of the Socket.
+   * @param name Name of the Socket.
+   * @param value_ptr Pointer where the input is fetched during evaluation.
+   */
+  template <typename T>
+  void SetInput(const char* name, T* value_ptr) {
+    m_node_descriptor->SetOutput(name, value_ptr);
+
+    for (int i = 0; i < m_node_output_connections[1].size(); i++) {
+      const AnimGraphConnection& graph_input_connection =
+          m_node_output_connections[1][i];
+
+      if (graph_input_connection.m_source_socket.m_name == name) {
+        *graph_input_connection.m_target_socket.m_reference.ptr_ptr = value_ptr;
+      }
+    }
+  }
+
+  /** Sets the address that is used for the specified AnimGraph output Socket.
+   *
+   * @tparam T Type of the Socket.
+   * @param name Name of the Socket.
+   * @param value_ptr Pointer where the graph output output is written to at the end of evaluation.
+   */
+  template <typename T>
+  void SetOutput(const char* name, T* value_ptr) {
+    m_node_descriptor->SetInput(name, value_ptr);
+
+    for (int i = 0; i < m_node_input_connections[0].size(); i++) {
+      const AnimGraphConnection& graph_output_connection =
+          m_node_input_connections[0][i];
+
+      if (graph_output_connection.m_target_socket.m_name == name) {
+        if (graph_output_connection.m_source_node == m_nodes[1]
+            && graph_output_connection.m_target_node == m_nodes[0]) {
+          std::cerr << "Error: cannot set output for direct graph input to graph "
+                       "output connections. Use GetOutptPtr for output instead!"
+                    << std::endl;
+
+          return;
+        }
+
+        *graph_output_connection.m_source_socket.m_reference.ptr_ptr =
+            value_ptr;
+
+        // Make sure all other output connections of this pin use the same output pointer
+        int source_node_index = getAnimNodeIndex(graph_output_connection.m_source_node);
+        for (int j = 0; j < m_node_output_connections[source_node_index].size(); j++) {
+          const AnimGraphConnection& source_output_connection = m_node_output_connections[source_node_index][j];
+          if (source_output_connection.m_target_node == m_nodes[0]) {
+            continue;
+          }
+
+          if (source_output_connection.m_source_socket.m_name == graph_output_connection.m_source_socket.m_name) {
+            *source_output_connection.m_target_socket.m_reference.ptr_ptr = value_ptr;
+          }
+        }
+      }
+    }
+  }
+
+  /** Returns the address that is used for the specified AnimGraph output Socket.
+   *
+   * This function is needed for connections that directly connect an AnimGraph
+   * input Socket to an output Socket of the same AnimGraph.
+   *
+   * @tparam T Type of the Socket.
+   * @param name Name of the Socket.
+   * @return Address that is used for the specified AnimGraph output Socket.
+   */
+  template <typename T>
+  T* GetOutputPtr(const char* name) {
+    for (int i = 0; i < m_node_input_connections[0].size(); i++) {
+      const AnimGraphConnection& graph_output_connection =
+          m_node_input_connections[0][i];
+      if (graph_output_connection.m_target_socket.m_name == name) {
+        return static_cast<float*>(*graph_output_connection.m_source_socket.m_reference.ptr_ptr);
+      }
+    }
+
+    return nullptr;
+  }
+
   void* getInputPtr(const std::string& name) const {
     const Socket* input_socket = getInputSocket(name);
     if (input_socket != nullptr) {

src/AnimGraph/AnimGraphData.h

@@ -108,17 +108,17 @@ struct AnimGraphContext {
   }
 };
 
-struct Vec3 {
+union Vec3 {
   struct {
     float x;
     float y;
     float z;
   };
 
-  float v[3] = { 0 };
+  float v[3] = {0};
 };
 
-struct Quat {
+union Quat {
   struct {
     float x;
     float y;
@@ -126,13 +126,14 @@ struct Quat {
     float w;
   };
 
-  float v[4] = { 0 };
+  float v[4] = {0};
 };
 
 enum class SocketType {
   SocketTypeUndefined = 0,
   SocketTypeBool,
   SocketTypeAnimation,
+  SocketTypeInt,
   SocketTypeFloat,
   SocketTypeVec3,
   SocketTypeQuat,
@@ -143,7 +144,7 @@ enum class SocketType {
 constexpr size_t cSocketStringValueMaxLength = 256;
 
 static const char* SocketTypeNames[] =
-    {"", "Bool", "Animation", "Float", "Vec3", "Quat", "String"};
+    {"", "Bool", "Animation", "Int", "Float", "Vec3", "Quat", "String"};
 
 enum SocketFlags { SocketFlagNone = 0, SocketFlagAffectsTime = 1 };
 
@@ -152,6 +153,7 @@ struct Socket {
   SocketType m_type = SocketType::SocketTypeUndefined;
   union SocketValue {
     bool flag;
+    int int_value;
     float float_value;
     Vec3 vec3;
     Quat quat;
@@ -165,6 +167,62 @@ struct Socket {
   SocketReference m_reference = {0};
   SocketFlags m_flags = SocketFlagNone;
   size_t m_type_size = 0;
+
+  template <typename T>
+  void SetValue(const T value) {
+    if constexpr (std::is_same<T, bool>::value) {
+      m_value.flag = value;
+    }
+
+    if constexpr (std::is_same<T, int>::value) {
+      m_value.int_value = value;
+    }
+
+    if constexpr (std::is_same<T, float>::value) {
+      m_value.float_value = value;
+    }
+
+    if constexpr (std::is_same<T, Vec3>::value) {
+      m_value.vec3 = value;
+    }
+
+    if constexpr (std::is_same<T, Quat>::value) {
+      m_value.quat = value;
+    }
+
+    if constexpr (std::is_same<T, std::string>::value) {
+      m_value_string = value;
+    }
+  }
+
+  template <typename T>
+  T GetValue() const {
+    if constexpr (std::is_same<T, bool>::value) {
+      return m_value.flag;
+    }
+
+    if constexpr (std::is_same<T, int>::value) {
+      return m_value.int_value;
+    }
+
+    if constexpr (std::is_same<T, float>::value) {
+      return m_value.float_value;
+    }
+
+    if constexpr (std::is_same<T, Vec3>::value) {
+      return m_value.vec3;
+    }
+
+    if constexpr (std::is_same<T, Quat>::value) {
+      return m_value.quat;
+    }
+
+    if constexpr (std::is_same<T, std::string>::value) {
+      return m_value_string;
+    }
+
+    return T();
+  }
 };
 
 template <typename T>
@@ -177,6 +235,10 @@ SocketType GetSocketType() {
     return SocketType::SocketTypeAnimation;
   }
 
+  if constexpr (std::is_same<T, int>::value) {
+    return SocketType::SocketTypeInt;
+  }
+
   if constexpr (std::is_same<T, float>::value) {
     return SocketType::SocketTypeFloat;
   }
@@ -256,6 +318,13 @@ struct NodeDescriptorBase {
     *socket->m_reference.ptr_ptr = value_ptr;
   }
 
+  template <typename T>
+  void SetInputValue(const char* name, T value) {
+    Socket* socket = FindSocket(name, m_inputs);
+    assert(GetSocketType<T>() == socket->m_type);
+    socket->SetValue(value);
+  }
+
   void SetInputUnchecked(const char* name, void* value_ptr) {
     Socket* socket = FindSocket(name, m_inputs);
     *socket->m_reference.ptr_ptr = value_ptr;
@@ -289,6 +358,14 @@ struct NodeDescriptorBase {
     return FindSocketIndex(name, m_outputs);
   }
 
+  /** Sets value of an AnimNode Socket.
+   *
+   * @note Should only be used when the NodeDescriptor is associated with an AnimNode instance.
+   *
+   * @tparam T can be any AnimGraph data type.
+   * @param Socket name
+   * @param value
+   */
   template <typename T>
   void SetProperty(const char* name, const T& value) {
     Socket* socket = FindSocket(name, m_properties);
@@ -296,6 +373,21 @@ struct NodeDescriptorBase {
     *static_cast<T*>(socket->m_reference.ptr) = value;
   }
 
+  /** Sets value of an AnimNodeResource Socket.
+   *
+   * @note Should only be used when the NodeDescriptor is associated with an AnimNodeResource instance. For AnimNode instances use Socket::SetProperty().
+   *
+   * @tparam T can be any AnimGraph data type.
+   * @param Socket name
+   * @param value
+   */
+  template <typename T>
+  void SetPropertyValue(const char* name, const T& value) {
+    Socket* socket = FindSocket(name, m_properties);
+    assert(GetSocketType<T>() == socket->m_type);
+    socket->SetValue(value);
+  }
+
   template <typename T>
   const T& GetProperty(const char* name) {
     Socket* socket = FindSocket(name, m_properties);
@@ -303,6 +395,15 @@ struct NodeDescriptorBase {
     return *static_cast<T*>(socket->m_reference.ptr);
   }
 
+  template <typename T>
+  T GetPropertyValue(const char* name) {
+    Socket* socket = FindSocket(name, m_properties);
+    assert(GetSocketType<T>() == socket->m_type);
+    return socket->GetValue<T>();
+  }
+
+  virtual void UpdateFlags(){};
+
  protected:
   Socket* FindSocket(const char* name, std::vector<Socket>& sockets) {
     for (int i = 0, n = sockets.size(); i < n; i++) {
@@ -324,8 +425,6 @@ struct NodeDescriptorBase {
     return -1;
   }
 
-  virtual void UpdateFlags(){};
-
   template <typename T>
   bool RegisterSocket(
       const char* name,

src/AnimGraph/AnimGraphEditor.cc

@@ -18,6 +18,8 @@ ImNodesPinShape sGetSocketShapeFromSocketType(const SocketType& socket_type) {
   switch (socket_type) {
     case SocketType::SocketTypeAnimation:
       return ImNodesPinShape_QuadFilled;
+    case SocketType::SocketTypeInt:
+      return ImNodesPinShape_CircleFilled;
     case SocketType::SocketTypeFloat:
       return ImNodesPinShape_CircleFilled;
     case SocketType::SocketTypeVec3:
@@ -66,7 +68,6 @@ void RemoveConnectionsForSocket(
   }
 }
 
-
 void SyncTrackEditor(SyncTrack* sync_track) {
   ImGui::SliderFloat("duration", &sync_track->m_duration, 0.001f, 10.f);
 
@@ -76,13 +77,13 @@ void SyncTrackEditor(SyncTrack* sync_track) {
   ImGui::SameLine();
   if (ImGui::Button("+")) {
     if (sync_track->m_num_intervals < cSyncTrackMaxIntervals) {
-      sync_track->m_num_intervals ++;
+      sync_track->m_num_intervals++;
     }
   }
   ImGui::SameLine();
   if (ImGui::Button("-")) {
     if (sync_track->m_num_intervals > 0) {
-      sync_track->m_num_intervals --;
+      sync_track->m_num_intervals--;
     }
   }
 
@@ -99,7 +100,7 @@ void SyncTrackEditor(SyncTrack* sync_track) {
         1.f);
   }
 
-  if (ImGui::Button ("Update Intervals")) {
+  if (ImGui::Button("Update Intervals")) {
     sync_track->CalcIntervals();
   }
 }
@@ -120,7 +121,11 @@ void SkinnedMeshWidget(SkinnedMesh* skinned_mesh) {
     items[i] = skinned_mesh->m_animation_names[i].c_str();
   }
 
-  ImGui::Combo("Animation", &selected, items, skinned_mesh->m_animations.size());
+  ImGui::Combo(
+      "Animation",
+      &selected,
+      items,
+      skinned_mesh->m_animations.size());
 
   ImGui::Text("Sync Track");
   if (selected >= 0 && selected < skinned_mesh->m_animations.size()) {
@@ -162,24 +167,38 @@ void AnimGraphEditorRenderSidebar(
   int num_properties = node_resource.m_socket_accessor->m_properties.size();
   for (int i = 0; i < num_properties; i++) {
     Socket& property = node_resource.m_socket_accessor->m_properties[i];
-    if (property.m_type == SocketType::SocketTypeFloat) {
+    if (property.m_type == SocketType::SocketTypeInt) {
+      ImGui::InputInt(
+          property.m_name.c_str(),
+          reinterpret_cast<int*>(&property.m_value.int_value),
+          1);
+    } else if (property.m_type == SocketType::SocketTypeFloat) {
       ImGui::SliderFloat(
           property.m_name.c_str(),
           reinterpret_cast<float*>(&property.m_value.float_value),
           -100.f,
           100.f);
     } else if (property.m_type == SocketType::SocketTypeBool) {
-      ImGui::Checkbox(
+      bool flag_value = property.GetValue<bool>();
+      if (ImGui::Checkbox(
           property.m_name.c_str(),
-          reinterpret_cast<bool*>(property.m_reference.ptr));
+          &flag_value)) {
+        property.SetValue(flag_value);
+      }
     } else if (property.m_type == SocketType::SocketTypeString) {
       char string_buf[1024];
-      memcpy (string_buf, property.m_value.string_ptr->c_str(), property.m_value.string_ptr->size() + 1);
+      memset(string_buf, '\0', sizeof(string_buf));
+      memcpy(
+          string_buf,
+          property.m_value_string.c_str(),
+          std::min(
+              static_cast<size_t>(1024),
+              property.m_value_string.size() + 1));
       if (ImGui::InputText(
               property.m_name.c_str(),
               string_buf,
               sizeof(string_buf))) {
-        *property.m_value.string_ptr = string_buf;
+        property.m_value_string = string_buf;
       }
     }
   }
@@ -291,6 +310,10 @@ void AnimGraphEditorUpdate() {
         node_type_name = "SpeedScale";
       }
 
+      if (ImGui::MenuItem("LockTranslationNode")) {
+        node_type_name = "LockTranslationNode";
+      }
+
       if (ImGui::MenuItem("MathAddNode")) {
         node_type_name = "MathAddNode";
       }
@@ -335,10 +358,10 @@ void AnimGraphEditorUpdate() {
     ImNodes::EndNodeTitleBar();
 
     // Inputs
-    const std::vector<Socket>& node_inputs =
+    std::vector<Socket>& node_inputs =
         node_resource.m_socket_accessor->m_inputs;
     for (size_t j = 0, ni = node_inputs.size(); j < ni; j++) {
-      const Socket& socket = node_inputs[j];
+      Socket& socket = node_inputs[j];
 
       ImColor socket_color = ImColor(255, 255, 255, 255);
       if (socket.m_flags & SocketFlagAffectsTime) {
@@ -353,12 +376,25 @@ void AnimGraphEditorUpdate() {
 
       bool socket_connected =
           sGraphGresource.isSocketConnected(node_resource, socket.m_name);
-      if (!socket_connected &&
-          (socket.m_type == SocketType::SocketTypeFloat)) {
+      if (!socket_connected && (socket.m_type == SocketType::SocketTypeFloat)) {
         ImGui::SameLine();
-        float socket_value = 0.f;
-        ImGui::PushItemWidth(100.0f - ImGui::CalcTextSize(socket.m_name.c_str()).x);
-        ImGui::DragFloat("##hidelabel", &socket_value, 0.01f);
+        float socket_value = socket.m_value.float_value;
+        ImGui::PushItemWidth(
+            130.0f - ImGui::CalcTextSize(socket.m_name.c_str()).x);
+        if (ImGui::DragFloat("##hidelabel", &socket_value, 0.01f)) {
+          socket.SetValue(socket_value);
+        }
+        ImGui::PopItemWidth();
+      }
+
+      if (!socket_connected && (socket.m_type == SocketType::SocketTypeInt)) {
+        ImGui::SameLine();
+        int socket_value = socket.m_value.int_value;
+        ImGui::PushItemWidth(
+            130.0f - ImGui::CalcTextSize(socket.m_name.c_str()).x);
+        if (ImGui::InputInt("##hidelabel", &socket_value, 1)) {
+          socket.SetValue(socket_value);
+        }
         ImGui::PopItemWidth();
       }
 
@@ -393,7 +429,7 @@ void AnimGraphEditorUpdate() {
         socket_name += std::to_string(
             graph_output_node.m_socket_accessor->m_inputs.size());
         graph_output_node.m_socket_accessor->RegisterInput<float>(
-            socket_name,
+            socket_name.c_str(),
             nullptr);
       }
     } else if (i == 1) {
@@ -406,7 +442,7 @@ void AnimGraphEditorUpdate() {
         socket_name += std::to_string(
             graph_input_node.m_socket_accessor->m_outputs.size());
         graph_input_node.m_socket_accessor->RegisterOutput<float>(
-            socket_name,
+            socket_name.c_str(),
             nullptr);
       }
     }
@@ -431,12 +467,12 @@ void AnimGraphEditorUpdate() {
     const AnimNodeResource& source_node =
         sGraphGresource.m_nodes[connection.source_node_index];
     int source_socket_index = source_node.m_socket_accessor->GetOutputIndex(
-        connection.source_socket_name);
+        connection.source_socket_name.c_str());
 
     const AnimNodeResource& target_node =
         sGraphGresource.m_nodes[connection.target_node_index];
     int target_socket_index = target_node.m_socket_accessor->GetInputIndex(
-        connection.target_socket_name);
+        connection.target_socket_name.c_str());
 
     start_attr = GenerateOutputAttributeId(
         connection.source_node_index,

src/AnimGraph/AnimGraphNodes.cc

@@ -82,10 +82,40 @@ void AnimSamplerNode::Evaluate(AnimGraphContext& context) {
   ozz::animation::SamplingJob sampling_job;
   sampling_job.animation = m_animation;
   sampling_job.context = &m_sampling_context;
-  sampling_job.ratio = m_time_now;
+  sampling_job.ratio = fmodf(m_time_now, m_animation->duration());
   sampling_job.output = make_span(o_output->m_local_matrices);
 
   if (!sampling_job.Run()) {
     ozz::log::Err() << "Error sampling animation." << std::endl;
   }
 }
+
+void LockTranslationNode::Evaluate(AnimGraphContext& context) {
+  o_output->m_local_matrices = i_input->m_local_matrices;
+  ozz::math::SoaFloat3 translation =
+      o_output->m_local_matrices[m_locked_bone_index].translation;
+  float x[4];
+  float y[4];
+  float z[4];
+  _mm_store_ps(x, translation.x);
+  _mm_store_ps(y, translation.y);
+  _mm_store_ps(z, translation.z);
+
+  if (m_lock_x) {
+    x[0] = 0.f;
+  }
+
+  if (m_lock_y) {
+    y[0] = 0.f;
+  }
+
+  if (m_lock_z) {
+    z[0] = 0.f;
+  }
+
+  translation.x = _mm_load_ps(x);
+  translation.y = _mm_load_ps(y);
+  translation.z = _mm_load_ps(z);
+
+  o_output->m_local_matrices[m_locked_bone_index].translation = translation;
+}

src/AnimGraph/AnimGraphNodes.h

@@ -156,8 +156,8 @@ struct SpeedScaleNode : public AnimNode {
   float* i_speed_scale = nullptr;
 
   void UpdateTime(float time_last, float time_now) override {
-    m_time_last = time_last;
-    m_time_now = time_last + (time_now - time_last) * (*i_speed_scale);
+    m_time_last = m_time_now;
+    m_time_now = m_time_last + (time_now - time_last) * (*i_speed_scale);
     m_state = AnimNodeEvalState::TimeUpdated;
   }
 
@@ -196,7 +196,7 @@ struct AnimSamplerNode : public AnimNode {
   virtual bool Init(AnimGraphContext& context) override;
   void UpdateTime(float time_last, float time_now) override {
     m_time_last = time_last;
-    m_time_now = fmodf(time_last + (time_now - time_last), m_animation->duration());
+    m_time_now = time_now;
     m_state = AnimNodeEvalState::TimeUpdated;
   }
   virtual void Evaluate(AnimGraphContext& context) override;
@@ -211,6 +211,34 @@ struct NodeDescriptor<AnimSamplerNode> : public NodeDescriptorBase {
   }
 };
 
+//
+// LockTranslationNode
+//
+struct LockTranslationNode : public AnimNode {
+  AnimData* i_input = nullptr;
+  AnimData* o_output = nullptr;
+  int m_locked_bone_index;
+  bool m_lock_x;
+  bool m_lock_y;
+  bool m_lock_z;
+
+  virtual void Evaluate(AnimGraphContext& context) override;
+};
+
+template <>
+struct NodeDescriptor<LockTranslationNode> : public NodeDescriptorBase {
+  NodeDescriptor(LockTranslationNode* node) {
+    RegisterInput("Input", &node->i_input);
+    RegisterOutput("Output", &node->o_output);
+
+    RegisterProperty("BoneIndex", &node->m_locked_bone_index);
+    RegisterProperty("LockAxisX", &node->m_lock_x);
+    RegisterProperty("LockAxisY", &node->m_lock_y);
+    RegisterProperty("LockAxisZ", &node->m_lock_z);
+  }
+};
+
+
 //
 // ConstScalarNode
 //
@@ -296,6 +324,8 @@ static inline AnimNode* AnimNodeFactory(const std::string& name) {
     result = new SpeedScaleNode;
   } else if (name == "AnimSampler") {
     result = new AnimSamplerNode;
+  } else if (name == "LockTranslationNode") {
+    result = new LockTranslationNode;
   } else if (name == "BlendTree") {
     result = new BlendTreeNode;
   } else if (name == "MathAddNode") {
@@ -324,6 +354,8 @@ static inline NodeDescriptorBase* AnimNodeDescriptorFactory(
     return CreateNodeDescriptor<SpeedScaleNode>(node);
   } else if (node_type_name == "AnimSampler") {
     return CreateNodeDescriptor<AnimSamplerNode>(node);
+  } else if (node_type_name == "LockTranslationNode") {
+    return CreateNodeDescriptor<LockTranslationNode>(node);
   } else if (node_type_name == "BlendTree") {
     return CreateNodeDescriptor<BlendTreeNode>(node);
   } else if (node_type_name == "MathAddNode") {

src/AnimGraph/AnimGraphResource.cc

@@ -4,6 +4,7 @@
 
 #include "AnimGraphResource.h"
 
+#include <cstring>
 #include <fstream>
 
 #include "3rdparty/json/json.hpp"
@@ -27,10 +28,15 @@ json sSocketToJson(const Socket& socket) {
   result["name"] = socket.m_name;
   result["type"] = sSocketTypeToStr(socket.m_type);
 
-  if (socket.m_reference.ptr != nullptr) {
+  if (socket.m_type == SocketType::SocketTypeString
+      && socket.m_value_string.size() > 0) {
+    result["value"] = socket.m_value_string;
+  } else if (socket.m_value.flag) {
     if (socket.m_type == SocketType::SocketTypeBool) {
       result["value"] = socket.m_value.flag;
     } else if (socket.m_type == SocketType::SocketTypeAnimation) {
+    } else if (socket.m_type == SocketType::SocketTypeInt) {
+      result["value"] = socket.m_value.int_value;
     } else if (socket.m_type == SocketType::SocketTypeFloat) {
       result["value"] = socket.m_value.float_value;
     } else if (socket.m_type == SocketType::SocketTypeVec3) {
@@ -42,8 +48,6 @@ json sSocketToJson(const Socket& socket) {
       result["value"][1] = socket.m_value.quat.v[1];
       result["value"][2] = socket.m_value.quat.v[2];
       result["value"][3] = socket.m_value.quat.v[3];
-    } else if (socket.m_type == SocketType::SocketTypeString) {
-      result["value"] = *static_cast<std::string*>(socket.m_reference.ptr);
     } else {
       std::cerr << "Invalid socket type '" << static_cast<int>(socket.m_type)
                 << "'." << std::endl;
@@ -59,25 +63,52 @@ Socket sJsonToSocket(const json& json_data) {
   result.m_name = json_data["name"];
 
   std::string type_string = json_data["type"];
+  bool have_value = json_data.contains("value");
 
   if (type_string == "Bool") {
     result.m_type = SocketType::SocketTypeBool;
     result.m_type_size = sizeof(bool);
+    if (have_value) {
+      result.m_value.flag = json_data["value"];
+    }
   } else if (type_string == "Animation") {
     result.m_type = SocketType::SocketTypeAnimation;
     result.m_type_size = sizeof(AnimData);
+  } else if (type_string == "Int") {
+    result.m_type = SocketType::SocketTypeInt;
+    result.m_type_size = sizeof(int);
+    if (have_value) {
+      result.m_value.int_value = json_data["value"];
+    }
   } else if (type_string == "Float") {
     result.m_type = SocketType::SocketTypeFloat;
     result.m_type_size = sizeof(float);
+    if (have_value) {
+      result.m_value.float_value = json_data["value"];
+    }
   } else if (type_string == "Vec3") {
     result.m_type = SocketType::SocketTypeVec3;
     result.m_type_size = sizeof(Vec3);
+    if (have_value) {
+      result.m_value.vec3.x = json_data["value"][0];
+      result.m_value.vec3.y = json_data["value"][1];
+      result.m_value.vec3.z = json_data["value"][2];
+    }
   } else if (type_string == "Quat") {
     result.m_type = SocketType::SocketTypeQuat;
     result.m_type_size = sizeof(Quat);
+    if (have_value) {
+      result.m_value.quat.x = json_data["value"][0];
+      result.m_value.quat.y = json_data["value"][1];
+      result.m_value.quat.z = json_data["value"][2];
+      result.m_value.quat.w = json_data["value"][3];
+    }
   } else if (type_string == "String") {
     result.m_type = SocketType::SocketTypeString;
     result.m_type_size = sizeof(std::string);
+    if (have_value) {
+      result.m_value_string = json_data["value"];
+    }
   } else {
     std::cerr << "Invalid socket type '" << type_string << "'." << std::endl;
   }
@@ -88,7 +119,10 @@ Socket sJsonToSocket(const json& json_data) {
 //
 // AnimGraphNode <-> json
 //
-json sAnimGraphNodeToJson(const AnimNodeResource& node) {
+json sAnimGraphNodeToJson(
+    const AnimNodeResource& node,
+    int node_index,
+    const std::vector<AnimGraphConnectionResource>& connections) {
   json result;
 
   result["name"] = node.m_name;
@@ -99,6 +133,27 @@ json sAnimGraphNodeToJson(const AnimNodeResource& node) {
     result["position"][j] = node.m_position[j];
   }
 
+  for (size_t j = 0, n = node.m_socket_accessor->m_inputs.size(); j < n; j++) {
+    const Socket& socket = node.m_socket_accessor->m_inputs[j];
+
+    if (socket.m_type == SocketType::SocketTypeAnimation) {
+      continue;
+    }
+
+    bool socket_connected = false;
+    for (size_t k = 0, m = connections.size(); k < m; k++) {
+      if (connections[k].source_node_index == node_index
+          && connections[k].source_socket_name == socket.m_name) {
+        socket_connected = true;
+        break;
+      }
+    }
+
+    if (!socket_connected) {
+      result["inputs"].push_back(sSocketToJson(socket));
+    }
+  }
+
   for (size_t j = 0, n = node.m_socket_accessor->m_properties.size(); j < n;
        j++) {
     Socket& property = node.m_socket_accessor->m_properties[j];
@@ -108,7 +163,7 @@ json sAnimGraphNodeToJson(const AnimNodeResource& node) {
   return result;
 }
 
-AnimNodeResource sAnimGraphNodeFromJson(const json& json_node) {
+AnimNodeResource sAnimGraphNodeFromJson(const json& json_node, int node_index) {
   AnimNodeResource result;
 
   result.m_name = json_node["name"];
@@ -123,36 +178,21 @@ AnimNodeResource sAnimGraphNodeFromJson(const json& json_node) {
   for (size_t j = 0, n = result.m_socket_accessor->m_properties.size(); j < n;
        j++) {
     Socket& property = result.m_socket_accessor->m_properties[j];
-    json json_property = json_node["properties"][property.m_name];
-
-    if (sSocketTypeToStr(property.m_type) == json_property["type"]) {
-      if (property.m_type == SocketType::SocketTypeBool) {
-        property.m_value.flag = json_property["value"];
-      } else if (property.m_type == SocketType::SocketTypeAnimation) {
-      } else if (property.m_type == SocketType::SocketTypeFloat) {
-        property.m_value.float_value = json_property["value"];
-      } else if (property.m_type == SocketType::SocketTypeVec3) {
-        property.m_value.vec3.v[0] = json_property["value"][0];
-        property.m_value.vec3.v[1] = json_property["value"][1];
-        property.m_value.vec3.v[2] = json_property["value"][2];
-      } else if (property.m_type == SocketType::SocketTypeQuat) {
-        Quat* property_quat = reinterpret_cast<Quat*>(property.m_reference.ptr);
-        property.m_value.quat.v[0] = json_property["value"][0];
-        property.m_value.quat.v[1] = json_property["value"][1];
-        property.m_value.quat.v[2] = json_property["value"][2];
-        property.m_value.quat.v[3] = json_property["value"][3];
-      } else if (property.m_type == SocketType::SocketTypeString) {
-        property.m_value_string = json_property["value"].get<std::string>();
-      } else {
-        std::cerr << "Invalid type for property '" << property.m_name
-                  << "'. Cannot parse json to type '"
-                  << static_cast<int>(property.m_type) << std::endl;
-        break;
+    property = sJsonToSocket(json_node["properties"][property.m_name]);
   }
-    } else {
-      std::cerr << "Invalid type for property '" << property.m_name
-                << "': expected " << sSocketTypeToStr(property.m_type)
-                << " but got " << json_property["type"] << std::endl;
+
+  if (node_index != 0 && node_index != 1 && json_node.contains("inputs")) {
+    for (size_t j = 0, n = json_node["inputs"].size(); j < n; j++) {
+      assert(json_node["inputs"][j].contains("name"));
+      std::string input_name = json_node["inputs"][j]["name"];
+      Socket* input_socket =
+          result.m_socket_accessor->GetInputSocket(input_name.c_str());
+      if (input_socket == nullptr) {
+        std::cerr << "Could not find input socket with name " << input_name
+                  << " for node type " << result.m_type_name << std::endl;
+        abort();
+      }
+      *input_socket = sJsonToSocket(json_node["inputs"][j]);
     }
   }
 
@@ -226,7 +266,7 @@ bool AnimGraphResource::saveToFile(const char* filename) const {
 
   for (size_t i = 0; i < m_nodes.size(); i++) {
     const AnimNodeResource& node = m_nodes[i];
-    result["nodes"][i] = sAnimGraphNodeToJson(node);
+    result["nodes"][i] = sAnimGraphNodeToJson(node, i, m_connections);
   }
 
   for (size_t i = 0; i < m_connections.size(); i++) {
@@ -283,7 +323,7 @@ bool AnimGraphResource::loadFromFile(const char* filename) {
   m_name = json_data["name"];
 
   // Load nodes
-  for (size_t i = 0; i < json_data["nodes"].size(); i++) {
+  for (size_t i = 0, n = json_data["nodes"].size(); i < n; i++) {
     const json& json_node = json_data["nodes"][i];
     if (json_node["type"] != "AnimNodeResource") {
       std::cerr
@@ -292,20 +332,20 @@ bool AnimGraphResource::loadFromFile(const char* filename) {
       return false;
     }
 
-    AnimNodeResource node = sAnimGraphNodeFromJson(json_node);
+    AnimNodeResource node = sAnimGraphNodeFromJson(json_node, i);
     m_nodes.push_back(node);
   }
 
   // Setup graph inputs and outputs
   const json& graph_outputs = json_data["nodes"][0]["inputs"];
-  for (size_t i = 0; i < graph_outputs.size(); i++) {
+  for (size_t i = 0, n = graph_outputs.size(); i < n; i++) {
     AnimNodeResource& graph_node = m_nodes[0];
     graph_node.m_socket_accessor->m_inputs.push_back(
         sJsonToSocket(graph_outputs[i]));
   }
 
   const json& graph_inputs = json_data["nodes"][1]["outputs"];
-  for (size_t i = 0; i < graph_inputs.size(); i++) {
+  for (size_t i = 0, n = graph_inputs.size(); i < n; i++) {
     AnimNodeResource& graph_node = m_nodes[1];
     graph_node.m_socket_accessor->m_outputs.push_back(
         sJsonToSocket(graph_inputs[i]));
@@ -357,15 +397,15 @@ void AnimGraphResource::createRuntimeNodeInstances(AnimGraph& instance) const {
 }
 
 void AnimGraphResource::prepareGraphIOData(AnimGraph& instance) const {
-  instance.m_socket_accessor =
+  instance.m_node_descriptor =
       AnimNodeDescriptorFactory("BlendTree", instance.m_nodes[0]);
-  instance.m_socket_accessor->m_outputs =
-      m_nodes[1].m_socket_accessor->m_outputs;
-  instance.m_socket_accessor->m_inputs = m_nodes[0].m_socket_accessor->m_inputs;
-  instance.m_socket_accessor->m_outputs =
+  instance.m_node_descriptor->m_outputs =
       m_nodes[1].m_socket_accessor->m_outputs;
+  instance.m_node_descriptor->m_inputs = m_nodes[0].m_socket_accessor->m_inputs;
 
-  // inputs
+  //
+  // graph inputs
+  //
   int input_block_size = 0;
   std::vector<Socket>& graph_inputs = instance.getGraphInputs();
   for (int i = 0; i < graph_inputs.size(); i++) {
@@ -381,14 +421,18 @@ void AnimGraphResource::prepareGraphIOData(AnimGraph& instance) const {
   for (int i = 0; i < graph_inputs.size(); i++) {
     graph_inputs[i].m_reference.ptr =
         (void*)&instance.m_input_buffer[input_block_offset];
+    instance.m_node_descriptor->m_outputs[i].m_reference.ptr =
+        &instance.m_input_buffer[input_block_offset];
     input_block_offset += sizeof(void*);
   }
 
-  // outputs
+  //
+  // graph outputs
+  //
   int output_block_size = 0;
   std::vector<Socket>& graph_outputs = instance.getGraphOutputs();
   for (int i = 0; i < graph_outputs.size(); i++) {
-    output_block_size += graph_outputs[i].m_type_size;
+    output_block_size += sizeof(void*);
   }
 
   if (output_block_size > 0) {
@@ -398,12 +442,13 @@ void AnimGraphResource::prepareGraphIOData(AnimGraph& instance) const {
 
   int output_block_offset = 0;
   for (int i = 0; i < graph_outputs.size(); i++) {
-    graph_outputs[i].m_reference.ptr =
+    instance.m_node_descriptor->m_inputs[i].m_reference.ptr =
         &instance.m_output_buffer[output_block_offset];
-    output_block_offset += graph_outputs[i].m_type_size;
+    output_block_offset += sizeof(void*);
   }
 
   // connections: make source and target sockets point to the same address in the connection data storage.
+  // TODO: instead of every connection, only create data blocks for the source sockets and make sure every source socket gets allocated once.
   int connection_data_storage_size = 0;
   for (int i = 0; i < m_connections.size(); i++) {
     const AnimGraphConnectionResource& connection = m_connections[i];
@@ -427,16 +472,13 @@ void AnimGraphResource::prepareGraphIOData(AnimGraph& instance) const {
         instance.m_nodes[i]);
   }
 
-  instance_node_descriptors[0]->m_inputs = instance.getGraphOutputs();
-  instance_node_descriptors[1]->m_outputs = instance.getGraphInputs();
+  instance_node_descriptors[0]->m_inputs = instance.m_node_descriptor->m_inputs;
+  instance_node_descriptors[1]->m_outputs =
+      instance.m_node_descriptor->m_outputs;
 
   int connection_data_offset = 0;
   for (int i = 0; i < m_connections.size(); i++) {
     const AnimGraphConnectionResource& connection = m_connections[i];
-    const AnimNodeResource& source_node_resource =
-        m_nodes[connection.source_node_index];
-    const AnimNodeResource& target_node_resource =
-        m_nodes[connection.target_node_index];
 
     NodeDescriptorBase* source_node_descriptor =
         instance_node_descriptors[connection.source_node_index];
@@ -470,131 +512,54 @@ void AnimGraphResource::prepareGraphIOData(AnimGraph& instance) const {
         &instance.m_connection_data_storage[connection_data_offset]);
 
     if (source_socket->m_type == SocketType::SocketTypeAnimation) {
-      instance.m_animdata_blocks.push_back((AnimData*)(
-          &instance.m_connection_data_storage[connection_data_offset]));
+      instance.m_animdata_blocks.push_back(
+          (AnimData*)(&instance
+                           .m_connection_data_storage[connection_data_offset]));
     }
 
     connection_data_offset += source_socket->m_type_size;
   }
 
+  //
+  // const node inputs
+  //
+  std::vector<Socket*> const_inputs =
+      getConstNodeInputs(instance, instance_node_descriptors);
+  int const_node_inputs_buffer_size = 0;
+  for (int i = 0, n = const_inputs.size(); i < n; i++) {
+    if (const_inputs[i]->m_type == SocketType::SocketTypeString) {
+      // TODO: implement string const node input support
+      std::cerr << "Error: const inputs for strings not yet implemented!"
+                << std::endl;
+      abort();
+    }
+    const_node_inputs_buffer_size += const_inputs[i]->m_type_size;
+  }
+
+  if (const_node_inputs_buffer_size > 0) {
+    instance.m_const_node_inputs = new char[const_node_inputs_buffer_size];
+    memset(instance.m_const_node_inputs, '\0', const_node_inputs_buffer_size);
+  }
+
+  int const_input_buffer_offset = 0;
+  for (int i = 0, n = const_inputs.size(); i < n; i++) {
+    Socket* const_input = const_inputs[i];
+
+    // TODO: implement string const node input support
+    assert(const_input->m_type != SocketType::SocketTypeString);
+
+    *const_input->m_reference.ptr_ptr =
+        &instance.m_const_node_inputs[const_input_buffer_offset];
+    memcpy (*const_input->m_reference.ptr_ptr, &const_input->m_value, const_inputs[i]->m_type_size);
+
+    const_input_buffer_offset += const_inputs[i]->m_type_size;
+  }
+
   for (int i = 0; i < m_nodes.size(); i++) {
     delete instance_node_descriptors[i];
   }
 }
 
-/*
-void AnimGraphResource::connectRuntimeNodes(AnimGraph& instance) const {
-  for (int i = 0; i < m_connections.size(); i++) {
-    const AnimGraphConnectionResource& connection = m_connections[i];
-    std::string source_node_type = "";
-    std::string target_node_type = "";
-    AnimNode* source_node = nullptr;
-    AnimNode* target_node = nullptr;
-    NodeSocketAccessorBase* source_node_accessor = nullptr;
-    NodeSocketAccessorBase* target_node_accessor = nullptr;
-    SocketType source_type;
-    SocketType target_type;
-    size_t source_socket_index = -1;
-    size_t target_socket_index = -1;
-
-    if (connection.source_node_index < 0
-        || connection.source_node_index >= m_nodes.size()) {
-      std::cerr << "Could not find source node index." << std::endl;
-      continue;
-    }
-
-    source_node = instance.m_nodes[connection.source_node_index];
-    source_node_type = source_node->m_node_type_name;
-    if (connection.source_node_index == 1) {
-      source_node_accessor = instance.m_socket_accessor;
-    } else {
-      source_node_accessor =
-          AnimNodeAccessorFactory(source_node_type, source_node);
-    }
-
-    if (connection.target_node_index < 0
-        || connection.target_node_index >= m_nodes.size()) {
-      std::cerr << "Could not find source node index." << std::endl;
-      continue;
-    }
-
-    target_node = instance.m_nodes[connection.target_node_index];
-    target_node_type = target_node->m_node_type_name;
-    if (connection.target_node_index == 0) {
-      target_node_accessor = instance.m_socket_accessor;
-    } else {
-      target_node_accessor =
-          AnimNodeAccessorFactory(target_node_type, target_node);
-    }
-
-    assert(source_node != nullptr);
-    assert(target_node != nullptr);
-
-    //
-    // Map resource node sockets to graph instance node sockets
-    //
-    source_socket_index =
-        source_node_accessor->GetOutputIndex(connection.source_socket_name);
-    if (source_socket_index == -1) {
-      std::cerr << "Invalid source socket " << connection.source_socket_name
-                << " for node " << source_node->m_name << "." << std::endl;
-      continue;
-    }
-    Socket* source_socket =
-        &source_node_accessor->m_outputs[source_socket_index];
-
-    target_socket_index =
-        target_node_accessor->GetInputIndex(connection.target_socket_name);
-    if (target_socket_index == -1) {
-      std::cerr << "Invalid target socket " << connection.target_socket_name
-                << " for node " << target_node->m_name << "." << std::endl;
-      continue;
-    }
-    Socket* target_socket =
-        &target_node_accessor->m_inputs[target_socket_index];
-
-    if (source_socket->m_type != target_socket->m_type) {
-      std::cerr << "Cannot connect sockets: invalid types!" << std::endl;
-    }
-
-    //
-    // Wire up outputs to inputs.
-    //
-    // Skip animation connections and connections to the output node as the
-    // pointers are already set up in AnimGraphResource::prepareGraphIOData().
-    if (target_socket->m_type != SocketType::SocketTypeAnimation
-        && connection.target_node_index != 0) {
-      (*target_socket->m_reference.ptr_ptr) = source_socket->m_reference.ptr;
-    }
-
-    size_t target_node_index = target_node->m_index;
-
-    // Register the runtime connection
-    AnimGraphConnection runtime_connection = {
-        source_node,
-        *source_socket,
-        target_node,
-        *target_socket};
-
-    std::vector<AnimGraphConnection>& target_input_connections =
-        instance.m_node_input_connections[target_node_index];
-    target_input_connections.push_back(runtime_connection);
-
-    std::vector<AnimGraphConnection>& source_output_connections =
-        instance.m_node_output_connections[source_node->m_index];
-    source_output_connections.push_back(runtime_connection);
-
-    if (target_node_accessor != instance.m_socket_accessor) {
-      delete target_node_accessor;
-    }
-
-    if (source_node_accessor != instance.m_socket_accessor) {
-      delete source_node_accessor;
-    }
-  }
-}
-*/
-
 void AnimGraphResource::setRuntimeNodeProperties(AnimGraph& instance) const {
   for (int i = 2; i < m_nodes.size(); i++) {
     const AnimNodeResource& node_resource = m_nodes[i];
@@ -615,6 +580,11 @@ void AnimGraphResource::setRuntimeNodeProperties(AnimGraph& instance) const {
               name.c_str(),
               property.m_value.flag);
           break;
+        case SocketType::SocketTypeInt:
+          node_instance_accessor->SetProperty(
+              name.c_str(),
+              property.m_value.int_value);
+          break;
         case SocketType::SocketTypeFloat:
           node_instance_accessor->SetProperty(
               name.c_str(),
@@ -644,3 +614,24 @@ void AnimGraphResource::setRuntimeNodeProperties(AnimGraph& instance) const {
     delete node_instance_accessor;
   }
 }
+
+std::vector<Socket*> AnimGraphResource::getConstNodeInputs(
+    AnimGraph& instance,
+    std::vector<NodeDescriptorBase*>& instance_node_descriptors) const {
+  std::vector<Socket*> result;
+
+  for (int i = 0; i < m_nodes.size(); i++) {
+    for (int j = 0, num_inputs = instance_node_descriptors[i]->m_inputs.size();
+         j < num_inputs;
+         j++) {
+      Socket& input = instance_node_descriptors[i]->m_inputs[j];
+
+      if (*input.m_reference.ptr_ptr == nullptr) {
+        memcpy(&input.m_value, &m_nodes[i].m_socket_accessor->m_inputs[j].m_value, sizeof(Socket::SocketValue));
+        result.push_back(&input);
+      }
+    }
+  }
+
+  return result;
+}

src/AnimGraph/AnimGraphResource.h

@@ -146,6 +146,7 @@ struct AnimGraphResource {
   void prepareGraphIOData(AnimGraph& instance) const;
   void connectRuntimeNodes(AnimGraph& instance) const;
   void setRuntimeNodeProperties(AnimGraph& instance) const;
+  std::vector<Socket*> getConstNodeInputs(AnimGraph& instance, std::vector<NodeDescriptorBase*>& instance_node_descriptors) const;
 };
 
 #endif  //ANIMTESTBED_ANIMGRAPHRESOURCE_H

src/main.cc

@@ -76,6 +76,7 @@ static struct {
   } loaded;
   struct {
     double frame;
+    double anim_update_time;
     float absolute;
     uint64_t laptime;
     float factor;
@@ -383,7 +384,8 @@ int main() {
 
   AnimGraph anim_graph;
   AnimGraphContext anim_graph_context;
-  AnimData* anim_graph_output = nullptr;
+  AnimData anim_graph_output;
+  anim_graph_output.m_local_matrices.resize(skinned_mesh.m_skeleton.num_soa_joints());
 
   state.time.factor = 1.0f;
 
@@ -510,7 +512,10 @@ int main() {
         stm_round_to_common_refresh_rate(stm_laptime(&state.time.laptime)));
 
     if (!state.time.paused) {
+      state.time.anim_update_time = state.time.frame;
       state.time.absolute += state.time.frame * state.time.factor;
+    } else {
+      state.time.anim_update_time = 0.;
     }
 
     if (state.ozz.animation != nullptr) {
@@ -617,7 +622,6 @@ int main() {
 
       if (ImGui::Button("Update Runtime Graph")) {
         anim_graph.dealloc();
-        anim_graph_output = nullptr;
 
         AnimGraphEditorGetRuntimeGraph(anim_graph);
         anim_graph_context.m_skeleton = &skinned_mesh.m_skeleton;
@@ -628,7 +632,7 @@ int main() {
         for (int i = 0; i < graph_output_sockets.size(); i++) {
           const Socket& output = graph_output_sockets[i];
           if (output.m_type == SocketType::SocketTypeAnimation) {
-            anim_graph_output = static_cast<AnimData*>(output.m_reference.ptr);
+            anim_graph.SetOutput(output.m_name.c_str(), &anim_graph_output);
           }
         }
       }
@@ -725,7 +729,8 @@ int main() {
 
         ImGui::SameLine();
         if (ImGui::Button("Step")) {
-          state.time.absolute += state.time.frame;
+          state.time.anim_update_time = 1. / 30.f;
+          state.time.absolute += state.time.anim_update_time;
         }
 
         if (state.ozz.animation != nullptr) {
@@ -758,10 +763,11 @@ int main() {
         skinned_mesh.CalcModelMatrices();
       }
 
-      if (state.time.use_graph && anim_graph.m_nodes.size() > 0) {
-        anim_graph.updateTime(state.time.frame);
+      if (state.time.use_graph && anim_graph.m_nodes.size() > 0 && state.time.anim_update_time > 0.) {
+        anim_graph.markActiveNodes();
+        anim_graph.updateTime(state.time.anim_update_time);
         anim_graph.evaluate(anim_graph_context);
-        skinned_mesh.m_local_matrices = anim_graph_output->m_local_matrices;
+        skinned_mesh.m_local_matrices = anim_graph_output.m_local_matrices;
 
         skinned_mesh.CalcModelMatrices();
       }

tests/AnimGraphEvalTests.cc

@@ -153,11 +153,11 @@ TEST_CASE_METHOD(
 
   // Setup nodes
   AnimNodeResource& trans_x_node = graph_resource.m_nodes[trans_x_node_index];
-  trans_x_node.m_socket_accessor->SetProperty("Filename", std::string("trans_x"));
+  trans_x_node.m_socket_accessor->SetPropertyValue("Filename", std::string("trans_x"));
   trans_x_node.m_name = "trans_x";
 
   AnimNodeResource& trans_y_node = graph_resource.m_nodes[trans_y_node_index];
-  trans_y_node.m_socket_accessor->SetProperty("Filename", std::string("trans_y"));
+  trans_y_node.m_socket_accessor->SetPropertyValue("Filename", std::string("trans_y"));
   trans_y_node.m_name = "trans_y";
 
   AnimNodeResource& blend_node = graph_resource.m_nodes[blend_node_index];
@@ -195,17 +195,15 @@ TEST_CASE_METHOD(
   graph.init(graph_context);
 
   // Get runtime graph inputs and outputs
-  float* graph_float_input = nullptr;
-  graph_float_input =
-      static_cast<float*>(graph.getInputPtr("GraphFloatInput"));
+  float graph_float_input = 0.f;
+  graph.SetInput("GraphFloatInput", &graph_float_input);
 
-  Socket* anim_output_socket =
-      graph.getOutputSocket("GraphOutput");
-
-  AnimData* graph_anim_output = static_cast<AnimData*>(graph.getOutputPtr("GraphOutput"));
+  AnimData graph_anim_output;
+  graph_anim_output.m_local_matrices.resize(skeleton->num_joints());
+  graph.SetOutput("GraphOutput", &graph_anim_output);
 
   // Evaluate graph
-  *graph_float_input = 0.1f;
+  graph_float_input = 0.1f;
 
   graph.markActiveNodes();
   CHECK(graph.m_nodes[trans_x_node_index]->m_state == AnimNodeEvalState::Activated);
@@ -215,6 +213,6 @@ TEST_CASE_METHOD(
   graph.updateTime(0.5f);
   graph.evaluate(graph_context);
 
-  CHECK(graph_anim_output->m_local_matrices[0].translation.x[0] == Approx(0.5).margin(0.1));
-  CHECK(graph_anim_output->m_local_matrices[0].translation.y[0] == Approx(0.05).margin(0.01));
+  CHECK(graph_anim_output.m_local_matrices[0].translation.x[0] == Approx(0.5).margin(0.1));
+  CHECK(graph_anim_output.m_local_matrices[0].translation.y[0] == Approx(0.05).margin(0.01));
 }

tests/AnimGraphResourceTests.cc

@@ -2,16 +2,15 @@
 // Created by martin on 04.02.22.
 //
 
-#include "ozz/base/io/archive.h"
-#include "ozz/base/io/stream.h"
-#include "ozz/base/log.h"
-
 #include "AnimGraph/AnimGraph.h"
 #include "AnimGraph/AnimGraphEditor.h"
 #include "AnimGraph/AnimGraphResource.h"
 #include "catch.hpp"
+#include "ozz/base/io/archive.h"
+#include "ozz/base/io/stream.h"
+#include "ozz/base/log.h"
 
-bool load_skeleton (ozz::animation::Skeleton& skeleton, const char* filename) {
+bool load_skeleton(ozz::animation::Skeleton& skeleton, const char* filename) {
   assert(filename);
   ozz::io::File file(filename, "rb");
   if (!file.opened()) {
@@ -32,7 +31,147 @@ bool load_skeleton (ozz::animation::Skeleton& skeleton, const char* filename) {
   return true;
 }
 
-TEST_CASE("BasicGraph", "[AnimGraphResource]") {
+TEST_CASE("AnimSamplerGraph", "[AnimGraphResource]") {
+  AnimGraphResource graph_resource;
+
+  graph_resource.clear();
+  graph_resource.m_name = "AnimSamplerGraph";
+
+  // Prepare graph inputs and outputs
+  size_t walk_node_index =
+      graph_resource.addNode(AnimNodeResourceFactory("AnimSampler"));
+
+  AnimNodeResource& walk_node = graph_resource.m_nodes[walk_node_index];
+  walk_node.m_name = "WalkAnim";
+  walk_node.m_socket_accessor->SetPropertyValue(
+      "Filename",
+      std::string("data/walk.anim.ozz"));
+
+  AnimNodeResource& graph_node = graph_resource.m_nodes[0];
+  graph_node.m_socket_accessor->RegisterInput<AnimData>("GraphOutput", nullptr);
+
+  graph_resource.connectSockets(
+      walk_node,
+      "Output",
+      graph_resource.getGraphOutputNode(),
+      "GraphOutput");
+
+  graph_resource.saveToFile("AnimSamplerGraph.animgraph.json");
+  AnimGraphResource graph_resource_loaded;
+  graph_resource_loaded.loadFromFile("AnimSamplerGraph.animgraph.json");
+
+  AnimGraph graph;
+  graph_resource_loaded.createInstance(graph);
+  AnimGraphContext graph_context;
+
+  ozz::animation::Skeleton skeleton;
+  REQUIRE(load_skeleton(skeleton, "data/skeleton.ozz"));
+  graph_context.m_skeleton = &skeleton;
+
+  REQUIRE(graph.init(graph_context));
+
+  REQUIRE(graph.m_nodes.size() == 3);
+  REQUIRE(graph.m_nodes[0]->m_node_type_name == "BlendTree");
+  REQUIRE(graph.m_nodes[1]->m_node_type_name == "BlendTree");
+  REQUIRE(graph.m_nodes[2]->m_node_type_name == "AnimSampler");
+
+  // connections within the graph
+  AnimSamplerNode* anim_sampler_walk =
+      dynamic_cast<AnimSamplerNode*>(graph.m_nodes[2]);
+
+  BlendTreeNode* graph_output_node =
+      dynamic_cast<BlendTreeNode*>(graph.m_nodes[0]);
+
+  // check node input dependencies
+  size_t anim_sampler_index = anim_sampler_walk->m_index;
+
+  REQUIRE(graph.m_node_output_connections[anim_sampler_index].size() == 1);
+  CHECK(
+      graph.m_node_output_connections[anim_sampler_index][0].m_target_node
+      == graph_output_node);
+
+  // Ensure animation sampler nodes use the correct files
+  REQUIRE(anim_sampler_walk->m_filename == "data/walk.anim.ozz");
+  REQUIRE(anim_sampler_walk->m_animation != nullptr);
+
+  // Ensure that outputs are properly propagated.
+  AnimData output;
+  output.m_local_matrices.resize(skeleton.num_soa_joints());
+  graph.SetOutput("GraphOutput", &output);
+  REQUIRE(anim_sampler_walk->o_output == &output);
+
+  WHEN("Emulating Graph Evaluation") {
+    CHECK(graph.m_anim_data_allocator.size() == 0);
+    anim_sampler_walk->Evaluate(graph_context);
+  }
+
+  graph_context.freeAnimations();
+}
+
+/*
+ * Checks that node const inputs are properly set.
+ */
+TEST_CASE("AnimSamplerSpeedScaleGraph", "[AnimGraphResource]") {
+  AnimGraphResource graph_resource;
+
+  graph_resource.clear();
+  graph_resource.m_name = "AnimSamplerSpeedScaleGraph";
+
+  // Prepare graph inputs and outputs
+  size_t walk_node_index =
+      graph_resource.addNode(AnimNodeResourceFactory("AnimSampler"));
+
+  size_t speed_scale_node_index =
+      graph_resource.addNode(AnimNodeResourceFactory("SpeedScale"));
+
+  AnimNodeResource& walk_node = graph_resource.m_nodes[walk_node_index];
+  walk_node.m_name = "WalkAnim";
+  walk_node.m_socket_accessor->SetPropertyValue(
+      "Filename",
+      std::string("data/walk.anim.ozz"));
+
+  AnimNodeResource& speed_scale_node =
+      graph_resource.m_nodes[speed_scale_node_index];
+  speed_scale_node.m_name = "SpeedScale";
+  float speed_scale_value = 1.35f;
+  speed_scale_node.m_socket_accessor->SetInputValue(
+      "SpeedScale",
+      speed_scale_value);
+
+  AnimNodeResource& graph_node = graph_resource.m_nodes[0];
+  graph_node.m_socket_accessor->RegisterInput<AnimData>("GraphOutput", nullptr);
+
+  graph_resource.connectSockets(walk_node, "Output", speed_scale_node, "Input");
+
+  graph_resource.connectSockets(
+      speed_scale_node,
+      "Output",
+      graph_resource.getGraphOutputNode(),
+      "GraphOutput");
+
+  graph_resource.saveToFile("AnimSamplerSpeedScaleGraph.animgraph.json");
+  AnimGraphResource graph_resource_loaded;
+  graph_resource_loaded.loadFromFile(
+      "AnimSamplerSpeedScaleGraph.animgraph.json");
+
+  Socket* speed_scale_resource_loaded_input =
+      graph_resource_loaded.m_nodes[speed_scale_node_index]
+          .m_socket_accessor->GetInputSocket("SpeedScale");
+  REQUIRE(speed_scale_resource_loaded_input != nullptr);
+
+  REQUIRE_THAT(
+      speed_scale_resource_loaded_input->m_value.float_value,
+      Catch::Matchers::WithinAbs(speed_scale_value, 0.1));
+
+  AnimGraph graph;
+  graph_resource_loaded.createInstance(graph);
+
+  REQUIRE_THAT(*dynamic_cast<SpeedScaleNode*>(graph.m_nodes[speed_scale_node_index])->i_speed_scale,
+               Catch::Matchers::WithinAbs(speed_scale_value, 0.1));
+}
+
+
+TEST_CASE("Blend2Graph", "[AnimGraphResource]") {
   AnimGraphResource graph_resource;
 
   graph_resource.clear();
@@ -48,9 +187,13 @@ TEST_CASE("BasicGraph", "[AnimGraphResource]") {
 
   AnimNodeResource& walk_node = graph_resource.m_nodes[walk_node_index];
   walk_node.m_name = "WalkAnim";
-  walk_node.m_socket_accessor->SetProperty("Filename", std::string("data/walk.anim.ozz"));
+  walk_node.m_socket_accessor->SetPropertyValue(
+      "Filename",
+      std::string("data/walk.anim.ozz"));
   AnimNodeResource& run_node = graph_resource.m_nodes[run_node_index];
-  run_node.m_socket_accessor->SetProperty("Filename", std::string("data/run.anim.ozz"));
+  run_node.m_socket_accessor->SetPropertyValue(
+      "Filename",
+      std::string("data/run.anim.ozz"));
   run_node.m_name = "RunAnim";
   AnimNodeResource& blend_node = graph_resource.m_nodes[blend_node_index];
   blend_node.m_name = "BlendWalkRun";
@@ -70,9 +213,9 @@ TEST_CASE("BasicGraph", "[AnimGraphResource]") {
       graph_resource.getGraphOutputNode(),
       "GraphOutput");
 
-  graph_resource.saveToFile("WalkGraph.animgraph.json");
+  graph_resource.saveToFile("Blend2Graph.animgraph.json");
   AnimGraphResource graph_resource_loaded;
-  graph_resource_loaded.loadFromFile("WalkGraph.animgraph.json");
+  graph_resource_loaded.loadFromFile("Blend2Graph.animgraph.json");
 
   AnimGraph graph;
   graph_resource_loaded.createInstance(graph);
@@ -130,35 +273,24 @@ TEST_CASE("BasicGraph", "[AnimGraphResource]") {
 
   WHEN("Emulating Graph Evaluation") {
     CHECK(graph.m_anim_data_allocator.size() == 0);
-    graph.prepareNodeEval(graph_context, walk_node_index);
-    graph.finishNodeEval(walk_node_index);
-
-    graph.prepareNodeEval(graph_context, run_node_index);
-    graph.finishNodeEval(run_node_index);
-
-    graph.prepareNodeEval(graph_context, blend_node_index);
     CHECK(blend2_instance->i_input0 == anim_sampler_walk->o_output);
     CHECK(blend2_instance->i_input1 == anim_sampler_run->o_output);
 
-    graph.finishNodeEval(blend_node_index);
-
-    // Evaluate output node.
-    graph.evalOutputNode();
-    graph.finishNodeEval(0);
-
     const Socket* graph_output_socket = graph.getOutputSocket("GraphOutput");
     AnimData* graph_output =
         static_cast<AnimData*>(*graph_output_socket->m_reference.ptr_ptr);
 
-    CHECK(graph_output->m_local_matrices.size() == graph_context.m_skeleton->num_soa_joints());
+    CHECK(
+        graph_output->m_local_matrices.size()
+        == graph_context.m_skeleton->num_soa_joints());
 
-    CHECK(blend2_instance->o_output == *graph_output_socket->m_reference.ptr_ptr);
+    CHECK(
+        blend2_instance->o_output == *graph_output_socket->m_reference.ptr_ptr);
   }
 
   graph_context.freeAnimations();
 }
 
-
 TEST_CASE("InputAttributeConversion", "[AnimGraphResource]") {
   int node_id = 3321;
   int input_index = 221;
@@ -178,7 +310,6 @@ TEST_CASE("InputAttributeConversion", "[AnimGraphResource]") {
   CHECK(output_index == parsed_output_index);
 }
 
-
 TEST_CASE("ResourceSaveLoadMathGraphInputs", "[AnimGraphResource]") {
   AnimGraphResource graph_resource_origin;
 
@@ -279,30 +410,30 @@ TEST_CASE("ResourceSaveLoadMathGraphInputs", "[AnimGraphResource]") {
             anim_graph.getInputPtr("GraphFloatInput")
             == anim_graph.m_input_buffer);
 
-        float* graph_float_input = nullptr;
-        graph_float_input =
-            static_cast<float*>(anim_graph.getInputPtr("GraphFloatInput"));
-
-        *graph_float_input = 123.456f;
+        float graph_float_input = 123.456f;
+        anim_graph.SetInput("GraphFloatInput", &graph_float_input);
 
         AND_WHEN("Evaluating Graph") {
           AnimGraphContext context;
           context.m_graph = &anim_graph;
 
+          anim_graph.init(context);
+
+          // GraphFloatOutput is directly connected to GraphFloatInput therefore
+          // we need to get the pointer here.
+          float* graph_float_ptr = nullptr;
+          graph_float_ptr = anim_graph.GetOutputPtr<float>("GraphFloatOutput");
+          Vec3 graph_vec3_output;
+          anim_graph.SetOutput("GraphVec3Output", &graph_vec3_output);
+
           anim_graph.updateTime(0.f);
           anim_graph.evaluate(context);
 
-          Socket* float_output_socket =
-              anim_graph.getOutputSocket("GraphFloatOutput");
-          Socket* vec3_output_socket =
-              anim_graph.getOutputSocket("GraphVec3Output");
-          Vec3& vec3_output =
-              *static_cast<Vec3*>(vec3_output_socket->m_reference.ptr);
-
           THEN("output vector components equal the graph input vaulues") {
-            CHECK(vec3_output.v[0] == *graph_float_input);
-            CHECK(vec3_output.v[1] == *graph_float_input);
-            CHECK(vec3_output.v[2] == *graph_float_input);
+            CHECK(graph_float_ptr == &graph_float_input);
+            CHECK(graph_vec3_output.v[0] == graph_float_input);
+            CHECK(graph_vec3_output.v[1] == graph_float_input);
+            CHECK(graph_vec3_output.v[2] == graph_float_input);
           }
 
           context.freeAnimations();
@@ -312,7 +443,6 @@ TEST_CASE("ResourceSaveLoadMathGraphInputs", "[AnimGraphResource]") {
   }
 }
 
-/*
 TEST_CASE("SimpleMathEvaluations", "[AnimGraphResource]") {
   AnimGraphResource graph_resource_origin;
 
@@ -416,41 +546,33 @@ TEST_CASE("SimpleMathEvaluations", "[AnimGraphResource]") {
           anim_graph.getInputPtr("GraphFloatInput")
           == anim_graph.m_input_buffer);
 
-      float* graph_float_input = nullptr;
-      graph_float_input =
-          static_cast<float*>(anim_graph.getInputPtr("GraphFloatInput"));
-
-      *graph_float_input = 123.456f;
+      float graph_float_input = 123.456f;
+      anim_graph.SetInput("GraphFloatInput", &graph_float_input);
 
       AND_WHEN("Evaluating Graph") {
         AnimGraphContext context;
         context.m_graph = &anim_graph;
 
+        // float0 output is directly connected to the graph input, therefore
+        // we have to get a ptr to the input data here.
+        float* float0_output_ptr = nullptr;
+        float float1_output = -1.f;
+        float float2_output = -1.f;
+
+        float0_output_ptr = anim_graph.GetOutputPtr<float>("GraphFloat0Output");
+
+        anim_graph.SetOutput("GraphFloat1Output", &float1_output);
+        anim_graph.SetOutput("GraphFloat2Output", &float2_output);
+
         anim_graph.updateTime(0.f);
         anim_graph.evaluate(context);
 
-        Socket* float0_output_socket =
-            anim_graph.getOutputSocket("GraphFloat0Output");
-        Socket* float1_output_socket =
-            anim_graph.getOutputSocket("GraphFloat1Output");
-        Socket* float2_output_socket =
-            anim_graph.getOutputSocket("GraphFloat2Output");
-
-        REQUIRE(float0_output_socket != nullptr);
-        REQUIRE(float1_output_socket != nullptr);
-        REQUIRE(float2_output_socket != nullptr);
-
-        float& float0_output =
-            *static_cast<float*>(float0_output_socket->m_reference.ptr);
-        float& float1_output =
-            *static_cast<float*>(float1_output_socket->m_reference.ptr);
-        float& float2_output =
-            *static_cast<float*>(float2_output_socket->m_reference.ptr);
-
         THEN("output vector components equal the graph input vaulues") {
-          CHECK(float0_output == Approx(*graph_float_input));
-          CHECK(float1_output == Approx(*graph_float_input * 2.));
-          CHECK(float2_output == Approx(*graph_float_input * 3.));
+          CHECK(*float0_output_ptr == Approx(graph_float_input));
+          CHECK(float1_output == Approx(graph_float_input * 2.f));
+          REQUIRE_THAT(
+              float2_output,
+              Catch::Matchers::WithinAbs(graph_float_input * 3.f, 10));
         }
 
         context.freeAnimations();
@@ -458,5 +580,3 @@ TEST_CASE("SimpleMathEvaluations", "[AnimGraphResource]") {
     }
   }
 }
-
-*/