过滤罗盘读数

Question

我正在使用罗盘标题来旋转 MKMapView。旋转有点不稳定，所以我试图像 iPhone 上的 Google 地图一样过滤它（或者似乎做了一些欺骗）。

我正在尝试使用移动平均公式过滤 iPhone 指南针的读数，但它在 359 和 0 之间的交叉处失败，因为它开始从 35x 向后平均到 0，并导致地图在从 359 向北接近时向后旋转。西方。

任何想法最好的方法是过滤这些数据，使其从 359 回到零并保持滚动平均值。

代码在这里：

- (void)locationManager:(CLLocationManager *)manager didUpdateHeading:(CLHeading *)newHeading {
static float xd=0;
static float k = 0.22;

// Moving average formula
xd = k * xd + (1.0 - k) * newHeading.magneticHeading;

NSLog(@"%0.2f : %0.2f", newHeading.magneticHeading, xd);    
[map setTransform:CGAffineTransformMakeRotation((-1 * xd * M_PI) /180)];}

感谢您的帮助

Answer 1

- (void)locationManager:(CLLocationManager *)manager didUpdateHeading:(CLHeading *)heading
{
    int newHeading;
    int queuecount;

    newHeading = heading.trueHeading;
    [queue addObject:[NSNumber numberWithInt:newHeading]];

    if([queue count] > 10) [queue removeObjectAtIndex:0];
    queuecount = [queue count];

    NSEnumerator *e = [queue objectEnumerator];
    NSNumber *sum;
    int oldd = 0 , newd, average =0;
    BOOL firstLoop = YES;
    while ((sum = [e nextObject])) 
    {
        newd = [sum intValue];
        if(firstLoop) {oldd = newd;firstLoop=NO;}

        if((newd +180) < oldd)
        {
            newd +=360; oldd = newd;
            average = average + newd;
            continue;
        }
        if((newd - 180) > oldd) 
        {
            newd -=360;oldd = newd;
            average = average + newd;
            continue;
        }

        average = average + newd;
        oldd = newd;

    }
    average = (average / queuecount) % 360;

    [map setTransform:CGAffineTransformMakeRotation((-1 * average * M_PI) /180)];

}

Answer 2

如果之前的移动平均线和新的方向相差超过 180 度，则以较小者为准加上 360。然后在存储新的移动平均线时除以 360。所以（没有精确的数学）：

HDG   MA
350   350
355   353
  0   356  (because 353 - 0 > 180 so adjusted HDG is 360)
  5   359  (likewise)
 10     2  (likewise, then 362 is new MA, mod 360 to normalize)
350   356  (because 2 - 350 < -180 so adjusted MA is 362)

我希望这能起作用，并且比平均角度中描述的三角方法更有效（归功于马克·兰塞姆（Mark Ransom）提到了这一点）。

Answer 3

我只是想添加我的 d0n 发布的代码版本，并进行一些调整。

我的代码是 Arduino 的 C 代码，所以我没有使用任何库（例如，我在没有 abs 函数的情况下获得绝对值）...

这个线程对我非常有帮助。谢谢 D0n 和约翰...

int Robot::getHeadingAverage() {

  // setup
  int lastReading = 0;
  int newReading = 0;
  int totalHeadings = 0;
  int avgHeading = 0;

  // loop through all the readings
  for(int i=0; i<totalHeadingReadings; i++) {
    // get the reading
    newReading = headings[i];

    // make sure we have an old reading
    if(i==0) {
      lastReading = newReading;
    }

    if((newReading + 180) < lastReading) {
      newReading = newReading + 360;
    }
    if((newReading - 180) > lastReading) {
      newReading = newReading - 360;
    }

    lastReading = newReading;
    totalHeadings = totalHeadings + newReading;

  }

  // get the average and make sure we do not end up over 360
  avgHeading = (totalHeadings / totalHeadingReadings) % 360;

  // check for negative value
  if(avgHeading < 0) {
    avgHeading = -1 * avgHeading; 
  }

  return avgHeading; 
}

Answer 4

最后，这对我有用。

• C# 代码。
• 尽管链接中的代码示例将使用度数，但以弧度为单位进行测量。 -
• 改编自https://rosettacode.org/wiki/Averages/Mean_angle。
• 省略的是类似于@d0n13的队列管理。

---

static double MeanAngle(List<double> angles)
{
    double x = 0, y = 0;
    foreach (double angle in angles)
    {
        x += Math.Cos(angle);
        y += Math.Sin(angle);
    }

    return Math.Atan2(y / angles.Count, x / angles.Count);
}