iOS 三次B样条曲线插值算法

points 为要插值的样条曲线型值点数组
fitPoints 为插值后的样条曲线型值点数组

- (void)fitSplineWith:(NSMutableArray *)points fitPoint:(NSMutableArray *)fitPoints {
    
    // 将坐标点数组CGPoint值转化为x,y形式
    const int len = (int)[points count];
    float x[len];
    float y[len];
    for (int i = 0; i < len; i++)
    {
        CGPoint p = [[points objectAtIndex:i] CGPointValue];
        // 检测出的点坐标是y,x形式,需要转换下
        x[i] = ceilf(p.y);
        y[i] = p.x;
        NSLog(@"%f,%f",x[i],y[i]);
    }
    
    
    float h[len];
    float u[len];
    float lam[len];
    for (int i = 0; i < len-1; i++)
    {
        h[i] = x[i+1] - x[i]; // 补偿
    }
    
    u[0] = 0;
    lam[0] = 1;
    for (int i = 1; i < (len - 1); i++)
    {
        u[i] = h[i-1]/(h[i] + h[i-1]);
        lam[i] = h[i]/(h[i] + h[i-1]);
    }
    
    // 三对角矩阵
    float a[len];
    float b[len];
    float c[len];
    
    float m[len][len];
    for (int i = 0; i < len; i++)
    {
        for (int j = 0; j < len; j++)
        {
            m[i][j] = 0;
        }
        if (i == 0)
        {
            m[i][0] = 2;
            m[i][1] = 1;
            
            b[0] = 2;
            c[0] = 1;
        }
        else if (i == (len - 1))
        {
            m[i][len - 2] = 1;
            m[i][len - 1] = 2;
            
            a[len-1] = 1;
            b[len-1] = 2;
        }
        else
        {
            m[i][i-1] = lam[i];
            m[i][i] = 2;
            m[i][i+1] = u[i];
            
            a[i] = lam[i];
            b[i] = 2;
            c[i] = u[i];
        }
    }
    
    // 等式右边矩阵
    float g[len];
    g[0] = 3 * (y[1] - y[0])/h[0];
    g[len-1] = 3 * (y[len - 1] - y[len - 2])/h[len - 2];
    for (int i = 1; i < len - 1; i++)
    {
        g[i] = 3 * ((lam[i] * (y[i] - y[i-1])/h[i-1]) + u[i] * (y[i+1] - y[i])/h[i]);
    }
    
    // 追逐法求解方程组得到【系数】
    float p[len];
    float q[len];
    
    p[0] = b[0];
    for (int i = 0; i < len - 1; i++)
    {
        q[i] = c[i]/p[i];
    }
    
    for (int i = 1; i < len; i++)
    {
        p[i] = b[i] - a[i]*q[i-1];
    }
    
    float su[len];
    float sq[len];
    float sx[len];
    
    su[0] = c[0]/b[0];
    sq[0] = g[0]/b[0];
    for (int i = 1; i < len - 1; i++)
    {
        su[i] = c[i]/(b[i] - su[i-1]*a[i]);
    }
    
    for (int i = 1; i < len; i++)
    {
        sq[i] = (g[i] - sq[i-1]*a[i])/(b[i] - su[i-1]*a[i]);
    }
    
    sx[len-1] = sq[len-1];
    for (int i = len - 2; i >= 0; i--)
    {
        sx[i] = sq[i] - su[i]*sx[i+1];
    }
    
    float *ph = h;
    float *px = x;
    float *psx = sx;
    float *py = y;
    
    /**
     曲线函数方程组 传入节点X和自变量vx值计算Y值

     @k 第几曲线段
     @vX 几点X坐标值
     返回几点Y坐标值
     */
    double (^func)(int k, float vX) = ^(int k, float vX) {
        double p1 =  (ph[k] + 2.0 * (vX - px[k])) * ((vX - px[k+1]) * (vX - px[k+1])) * py[k] / (ph[k] *ph[k] * ph[k]);
        double p2 =  (ph[k] - 2 * (vX - px[k+1])) * powf((vX - px[k]), 2.0f) * py[k+1] / powf(ph[k], 3.0f);
        double p3 =  (vX - px[k]) * powf((vX - px[k+1]), 2.0f) * psx[k] / powf(ph[k], 2.0f);
        double p4 =  (vX - px[k+1]) * powf((vX - px[k]), 2.0f) * psx[k+1] / powf(ph[k], 2.0f);
        return p1 + p2 + p3 + p4;
    };
    
    // 根据步长插入节点,计算y值
    for (int i = 0; i < [points count]; i++)
    {
        int count = 0;
        for (NSValue *val in points) {
            count++;
            CGPoint p = [val CGPointValue];
            
            NSLog(@"插值点:%f,%f  === Count:%d",p.x,p.y,count);
        }
        // 起点
        CGPoint p0 = [[points objectAtIndex:i] CGPointValue];  
        CGPoint pt = CGPointMake(ceilf(p0.y), p0.x);
        if (i == 0)
        {
//            [fitPoints addObject:[NSValue valueWithCGPoint:pt]];
        }
        else
        {
            CGPoint temP = [[points objectAtIndex:i-1] CGPointValue];
            CGPoint curP = CGPointMake(ceilf(temP.y), temP.x);
            
            // 步长
            float delta = 1.0f;
            
            for (float pointX = curP.x; fabs(pointX - pt.x) > 1e-4f; pointX += delta)
            {
                // x点对应的y值
                float pointY = func(i-1, pointX);
                
                // 存入插点数组中需要转换x,y
                CGPoint fitPoint = CGPointMake(pointX, pointY);
                NSLog(@"算法内最后插入点的值:%f,%f",pointY,pointX);
                [fitPoints addObject:[NSValue valueWithCGPoint:fitPoint]];
            }
            // 终点
            if (i == [points count] - 1) {
//                [fitPoints addObject:[NSValue valueWithCGPoint:pt]];
            }
        }
    }

}
最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 159,117评论 4 362
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 67,328评论 1 293
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 108,839评论 0 243
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 44,007评论 0 206
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 52,384评论 3 287
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 40,629评论 1 219
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 31,880评论 2 313
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 30,593评论 0 198
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 34,313评论 1 243
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 30,575评论 2 246
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 32,066评论 1 260
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 28,392评论 2 253
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 33,052评论 3 236
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 26,082评论 0 8
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 26,844评论 0 195
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 35,662评论 2 274
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 35,575评论 2 270

推荐阅读更多精彩内容

  • 1. 拉格朗日多项式插值 了解概念 插值多项式插值节点范德蒙特(Vandermonde)行列式截断误差、插值余项...
    野狗子嗷嗷嗷阅读 2,486评论 0 3
  • 1. 拉格朗日多项式插值 了解概念 插值多项式插值节点范德蒙特(Vandermonde)行列式截断误差、插值余项...
    野狗子嗷嗷嗷阅读 2,639评论 0 9
  • 这篇文章详细的介绍了spark广播变量,值得一看 https://jaceklaskowski.gitbooks....
    Woople阅读 1,870评论 0 0
  • Author黄哲铿读者锅巴GG 虽然这本书的名字有点吓人,但是等我读完,我非常能认同作者的感受。当你把所学、所思、...
    锅巴GG阅读 2,554评论 0 3
  • 南希处在比玛丽好的地位上,因为她回答对了。但是,她并不知道,因为知道不仅包括回答正确。还包括意识到你已经拥有它。 ...
    张添雅阅读 152评论 0 1