0

我写了一个算法来检测跌倒与 kinect 传感器。现在我详细说明我的联合头。我在这个视图中计算了与地板的距离：

public void verificaCaduta(SkeletonFrame skeletonFrame, KinectDati_Joints joints)
        {
            if (skeletonFrame != null && joints != null)
            {
                float A = skeletonFrame.FloorClipPlane.Item1;
                float B = skeletonFrame.FloorClipPlane.Item2;
                float C = skeletonFrame.FloorClipPlane.Item3;
                float D = skeletonFrame.FloorClipPlane.Item4;

                //dovrei calcolare la distanza dal pavimento
                //joint head
                float addendo1 = A * joints.head.Position.X;
                float addendo2 = B * joints.head.Position.Y;
                float addendo3 = C * joints.head.Position.Z;

                float addendo1_d = A * A;
                float addendo2_d = B * B;
                float addendo3_d = C * C;


                float numeratore = addendo1 + addendo2 + addendo3 + D;
                float denominatore = addendo1_d + addendo2_d + addendo3_d;

                float distanza = numeratore / (float)System.Math.Sqrt(denominatore);
              //  Console.WriteLine("probabile caduta " + distanza);

                if (distanza <= 0.60)
                {
                    Console.WriteLine("fall detection ?");
                }
            }
        }

如果与地板的距离在 0.6 i 之前检测到跌倒。但现在我会使算法复杂化。我会计算所有JOINT与地板的距离并结合信息。

我们能帮帮我吗？？？？

问候所有

4

1 回答 1

0

将距离计算代码提取到方法“DistanceFromJointToFloor”中，然后遍历调用该新方法的每个关节。将距离结果与阈值 0.6f 进行比较：

public float DistanceToFloor(SkeletonFrame skeletonFrame, Joints joint)
{
    float A = skeletonFrame.FloorClipPlane.Item1;
    float B = skeletonFrame.FloorClipPlane.Item2;
    float C = skeletonFrame.FloorClipPlane.Item3;
    float D = skeletonFrame.FloorClipPlane.Item4;

    //dovrei calcolare la distanza dal pavimento
    //joint head
    float addendo1 = A * joints.head.Position.X;
    float addendo2 = B * joints.head.Position.Y;
    float addendo3 = C * joints.head.Position.Z;

    float addendo1_d = A * A;
    float addendo2_d = B * B;
    float addendo3_d = C * C;


    float numeratore = addendo1 + addendo2 + addendo3 + D;
    float denominatore = addendo1_d + addendo2_d + addendo3_d;

    float distanza = numeratore / (float)System.Math.Sqrt(denominatore);
    return distanza;
}

那么您修改后的方法如下所示（注意：我不知道 KinectDati_Joints 是什么类型，但我认为它是一个可以从中提取关节的集合）：

public void verificaCaduta(SkeletonFrame skeletonFrame, KinectDati_Joints joints)
{
    if (skeletonFrame != null && joints != null)
    {
        foreach(Joint joint in joints)
        {
            float distanza = DistanceToFloor(skeletonFrame, joint);
            if (distanza <= 0.60)
            {
                   Console.WriteLine("fall detection ?");
                   Console.WriteLine("with joint: " + joint);
                   Console.WriteLine("distance:" + distanza);
            }
        }   
    }
}
于 2014-03-15T06:11:31.770 回答