(角落里的小点是节点,红点是被跟踪的人)
坐标:
Node X Y Position
1 0 0 Top left
2 450 0 Top right
3 0 450 Bottom left
4 450 450 Bottom right
Person X Y
Red dot 84 68
获取信号强度的方法:
(只需要相对于其他节点的信号强度,这似乎可以实现。或者我在这里错了吗?)
public int GetSignalStrength(OvalShape node)
{
int xd = node.Left - this.person.Left;
int yd = node.Top - this.person.Top;
var signalStrength = Math.Sqrt((xd * xd) + (yd * yd));
return Convert.ToInt32(-signalStrength);
}
信号强度:
Node Signal Strength
1 -108
2 -372
3 -391
4 -529
获取人物坐标的方法:
(s1、s2、s3、s4是上面的信号强度)
public int[] GetPositionInGrid(int s1, int s2, int s3, int s4)
{
var tx1 = this.node1.Left;
var ty1 = this.node1.Top;
var tx2 = this.node2.Left;
var ty2 = this.node2.Top;
var tx3 = this.node3.Left;
var ty3 = this.node3.Top;
var tx4 = this.node4.Left;
var ty4 = this.node4.Top;
double w1 = ((double)s1) / ((double)(s1 + s2 + s3 + s4));
double w2 = ((double)s2) / ((double)(s1 + s2 + s3 + s4));
double w3 = ((double)s3) / ((double)(s1 + s2 + s3 + s4));
double w4 = ((double)s4) / ((double)(s1 + s2 + s3 + s4));
var px = ((tx1 * w1) + (tx2 * w2) + (tx3 * w3) + (tx4 * w4)) / (w1 + w2 + w3 + w4);
var py = ((ty1 * w1) + (ty2 * w2) + (ty3 * w3) + (ty4 * w4)) / (w1 + w2 + w3 + w4);
return new int[] { Convert.ToInt32(px), Convert.ToInt32(py) };
}
人物定位:
x: 290
y: 296
正如你所看到的,我的数学不是那么好,而且“人的位置”也很遥远。这并不重要,但如果这个人在网格的中间,它就会起作用。
我正在假设如果每个节点都具有相同的信号强度,则该人位于网格的中间。
有人可以帮我吗?一段时间以来一直在谷歌搜索并将我的头撞在桌子上。