矩阵求逆(c++)

简要过程介绍

方法的名称是“Gauss-Jordan (or reduced row) elimination method”。

设对角矩阵为D,设矩阵I为M矩阵的逆矩阵,则MI=D,DI=I。

主要过程为,摆一个相同大小的对角矩阵在旁边,将原矩阵变成对角矩阵的过程中,对对角矩阵施以相同的变化。原理为,对矩阵施以特定变化等同于对矩阵进行线性计算。

实现过程

第一步:

准备阶段:进行 行与行的变换,使矩阵对角位的数值非0。

过程如下:

按顺序我们先从第一行开始。

查看后面所有行中位于第一个位置的元素的绝对值,找到绝对值最大的那一行,将其与第一行位置交换。

如果绝对值最大为0,此矩阵不可逆,退出。

紧接着做第二行,依旧查看后续行中位于第二列的元素中绝对值,将绝对值最大的行与第二行交换。

代码为一个4*4的矩阵求逆(4*4矩阵在图形学中用途最广)

int i, j, k;
    Matrix44<T> s;
    Matrix44<T> t(*this);
    for (i = 0; i < 3; i++) {//找到下三角每列的绝对最大值
        int pivot = i;
        T pivotsize = t[i][i];
        if (pivotsize < 0)pivotsize = -pivotsize;
        for (j = i + 1; j < 4; j++) {
            T tmp = t[j][i];
            if (tmp < 0)tmp = -tmp;
            if (tmp > pivotsize) {
                pivot = j;
                pivotsize = tmp;
            }
        }
        if (pivotsize == 0) {
            //can not inverse
            return Matrix44();
        }
        if (pivot != i)//交换两行,使对角位的值为该列最大
        {
            for (j = 0; j < 4; j++) {
                T tmp;
                tmp = t[i][j];
                t[i][j] = t[pivot][j];
                t[pivot][j] = tmp;
                tmp = s[i][j];
                s[i][j] = s[pivot][j];
                s[pivot][j] = tmp;
            }
        }
    

第二步:

将下三角所有数值置为0。
对于交换后的每一行,从它的下一行开始进行操作。
对于第 i 行,那么从 i+1行开始,对于每一行,设定一个因子。
该行-(第i行*因子),使该行的第 i 列的值为 0 。
结果为,做完第 i 行,后续所有行的第 i 列都为 0 。

//将下三角值设定为0
        for (j = i + 1; j < 4; j++) {
            T f = t[j][i] / t[i][i];
            for (k = 0; k < 4; k++) {
                t[j][k] -= t[i][k] * f;
                s[j][k] -= s[i][k] * f;
            }
        }   
    }

第三步:

先判断现在是否有对角位为0 的情况,如果有,则证明矩阵不可逆。因为如果此时对角位为0,则该行一定可以被其他行表示。
再将对角位置为1:
每一行都乘以一个相同因子使对角位都为1。
(现在就可以做这一步,因为后续步骤并不会改变对角位了。)

后续需要把上三角都置为0,过程与第二步类似。

for (i = 3; i >= 0; i--) {
        T f;
        f = t[i][i];
        if (f == 0)return Matrix44<T>();
        for (j = 0; j < 4; j++) {//将对角位置为1
            t[i][j] /= f;
            s[i][j] /= f;
        }
        for (j = 0; j < i; j++) {
            f = t[j][i];
            for (k = 0; k < 4; k++) {
                t[j][k] -= f*t[i][k];
                s[j][k] -= f*s[i][k];
            }
        }
    }

完整代码如下:

    int i, j, k;
    Matrix44<T> s;
    Matrix44<T> t(*this);
    for (i = 0; i < 3; i++) {//找到下三角每列的绝对最大值
        int pivot = i;
        T pivotsize = t[i][i];
        if (pivotsize < 0)pivotsize = -pivotsize;
        for (j = i + 1; j < 4; j++) {
            T tmp = t[j][i];
            if (tmp < 0)tmp = -tmp;
            if (tmp > pivotsize) {
                pivot = j;
                pivotsize = tmp;
            }
        }
        if (pivotsize == 0) {
            //can not inverse
            return Matrix44();
        }
        if (pivot != i)//交换两行,使对角位的值为该列最大
        {
            for (j = 0; j < 4; j++) {
                T tmp;
                tmp = t[i][j];
                t[i][j] = t[pivot][j];
                t[pivot][j] = tmp;
                tmp = s[i][j];
                s[i][j] = s[pivot][j];
                s[pivot][j] = tmp;
            }
        }
        //将下三角值设定为0
        for (j = i + 1; j < 4; j++) {
            T f = t[j][i] / t[i][i];
            for (k = 0; k < 4; k++) {
                t[j][k] -= t[i][k] * f;
                s[j][k] -= s[i][k] * f;
            }
        }   
    }
    
    for (i = 3; i >= 0; i--) {
        T f;
        f = t[i][i];
        if (f == 0)return Matrix44<T>();
        for (j = 0; j < 4; j++) {//将对角位置为1
            t[i][j] /= f;
            s[i][j] /= f;
        }
        for (j = 0; j < i; j++) {
            f = t[j][i];
            for (k = 0; k < 4; k++) {
                t[j][k] -= f*t[i][k];
                s[j][k] -= f*s[i][k];
            }
        }
    }

    return s;
}

代码来源:

https://www.scratchapixel.com

注:这是一个图形学学习的网站

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

推荐阅读更多精彩内容