使用Core Motion进行道路颠簸检测

时间:2015-01-28 07:09:41

标签: ios

我正在尝试创建一个应用程序,在驾驶时检测道路颠簸或坑洼,我在谷歌搜索可能的解决方案,我找到了一个使用加速度计值来检测道路颠簸的解决方案。

我已经使用了这个链接的代码,当你用手掌敲击手机但是在开车时没有检测到颠簸是很好的。 iOS: Accurately determining energy of a bump from accelerometer output

我还找到了一个可用于查找道路颠簸的算法Z-Diff,该算法的解释如下:http://open-sci.net/wiki/sealappexamplepotholes

这是我使用过的代码:

typedef struct {     double x,y,z; } vec_d3;

#define RECENT_COUNT 10
#define SMOOTH_IP(x,x_new,fac) x = fac * x + (1. -fac) * x_new
#define DOUBLE_EMPTY DBL_MAX

-(void)startTakingMotionValues{



[motionManager startAccelerometerUpdatesToQueue:[NSOperationQueue currentQueue] withHandler:^(CMAccelerometerData *accelerometerData, NSError *error) {


    static vec_d3 smooth = {DOUBLE_EMPTY,0,0};
    {
        if(smooth.x == DOUBLE_EMPTY){
            smooth.x=accelerometerData.acceleration.x;
            smooth.y=accelerometerData.acceleration.y;
            smooth.z=accelerometerData.acceleration.z;

            return;
        }
        SMOOTH_IP(smooth.x, accelerometerData.acceleration.x, 0.9);
        SMOOTH_IP(smooth.y, accelerometerData.acceleration.y, 0.9);
        SMOOTH_IP(smooth.z, accelerometerData.acceleration.z, 0.9);
    }

    // keep track of last k smoother acceleration values
    static vec_d3 recent[RECENT_COUNT];
    {
        static int ptr=0;
        static BOOL gotEnoughData = NO;

        recent[ptr]= smooth;
        ptr++;
        if(ptr==RECENT_COUNT){
            ptr=0;
            gotEnoughData=YES;
        }
        if (!gotEnoughData) {
            return;
        }
    }
    //get the resultant variation in acceleration over the whole array
    double variation;
    {
        vec_d3 min = smooth,max=smooth;
        for (int i=0; i< RECENT_COUNT; i++) {
            min.x = MIN(min.x, recent[i].x);
            min.y = MIN(min.y, recent[i].y);
            min.z = MIN(min.z, recent[i].z);

            max.x = MAX(max.x, recent[i].x);
            max.y = MAX(max.y, recent[i].y);
            max.z = MAX(max.z, recent[i].z);
        }
        vec_d3 V = (vec_d3)
        {
            .x = max.x - min.x,
            .y = max.y - min.y,
            .z = max.z - min.z
        };
        variation =sqrt(
                        V.x * V.x +
                        V.y * V.y +
                        V.z * V.z
                        );
    }
    //smooth it
    static double var_smoothed = DOUBLE_EMPTY;
    {
        if (var_smoothed == DOUBLE_EMPTY) {
            var_smoothed = variation;
            return;
        }
        SMOOTH_IP(var_smoothed, variation, 0.9);
    }

    // see if it's just passed a peak
    {
        static double varSmoothed_last = DOUBLE_EMPTY;
        if (varSmoothed_last == DOUBLE_EMPTY) {
            varSmoothed_last=var_smoothed;
            return;
        }
        static double varSmoother_preLast = DOUBLE_EMPTY;
        if (varSmoother_preLast == DOUBLE_EMPTY) {
            varSmoother_preLast = varSmoothed_last;
            varSmoothed_last = var_smoothed;
            return;
        }

#define THRESHOLD_IMPLUSE .40

        if (varSmoothed_last > varSmoother_preLast &&
            varSmoothed_last > var_smoothed &&
            varSmoothed_last > THRESHOLD_IMPLUSE) {
            didFindLocation=NO;
            if (newLocation.speed < 5) {

            }else{
            NSLog(@"varSmoothed_last: @ %f",varSmoothed_last);
            NSLog(@"varSmoother_preLast : %f",varSmoother_preLast);
            NSLog(@"var_smoothed : %f",var_smoothed);

            [self.bumpsData addObject:[NSString stringWithFormat:@"%f",varSmoothed_last]];
            [self.bumpsTableView reloadData];
            }

            //[self peakedWithImpulse: varSmoothed_last ];

        }
        varSmoother_preLast = varSmoothed_last;
        varSmoothed_last = var_smoothed;
    }

    }];
}

1 个答案:

答案 0 :(得分:1)

您需要首先播放参数,以了解算法如何调整到不同的频率敏感度:

#define THRESHOLD_IMPLUSE .40
#define RECENT_COUNT 10

你也可以尝试调整平滑系数0.9:

SMOOTH_IP(smooth.x, accelerometerData.acceleration.x, 0.9);

您正试图隔离指示道路颠簸的幅度和波长。调整RECENT_COUNT或平滑系数可以降低对高频凸起的敏感度。调整THRESHOLD_IMPULSE可能会影响幅度截止。

要测量这些对结果的影响,您还应该设计一些测试和测量方法。 录制来自道路颠簸的一些数据可以帮助您了解您希望检测到的行为。

一旦你理解了算法并对其进行了调整,如果它仍然无法隔离你所追求的移动,你应该看看你的第一个链接中的其他算法,分别理解它们,并尝试添加他们混在一起。