public void OnTrajectoryUpdated(Vector3 translation, Vector3 velocity, Vector3 yaw, Vector3 pitch)
{
Translation = translation;
Rotation = yaw;
var localVelocity = GlobalTransform.Inverse().basis.Xform(velocity);
animTree.Set("parameters/locomotion/blend_position", new Vector2(localVelocity.x, localVelocity.z));
//Pitch will be used when we have IK working with the model.
}