青青草原综合久久大伊人导航_色综合久久天天综合_日日噜噜夜夜狠狠久久丁香五月_热久久这里只有精品

是塵封已久的記憶再次融化 是堆積心底的烈火再次燃燒 是直覺讓我來到這久違的大地 是信念讓我開始了新的征途 在硝煙中我得到了成長 在傷痛中我學會了堅強 在沉默中我明白了等待 在孤獨中我體味了感傷 并不是我不懂得眼淚 并不是我只知道使命 在內心深處我同你一樣火熱 在我的眼中也有著多情的淚光 也許我的生命如落葉般短暫 也許我只是歲月長河中的一個過客 但我對自己所做的一切無怨無悔 因為我品嘗到了那最后一刻的淚光
隨筆-6  評論-24  文章-8  trackbacks-0
#include <math.h>
#include <iostream.h>

struct Quaternion
{
    float x;
    float y;
    float z;
    float w;
};

struct rotMatrix
{
    float m11, m12, m13;
    float m21, m22, m23;
    float m31, m32, m33;
};


//fuction:旋轉矩陣到四元數的轉換
void rotMatrixToQuternion(Quaternion &q, rotMatrix &r)
{
    float tr = r.m11 + r.m22 +r.m33;
    float temp = 0.0;
    if(tr > 0.0)
    {
        temp = 0.5f / sqrtf(tr+1);
        q.w = 0.25f / temp;
        q.x = (r.m23 - r.m32) * temp;
        q.y = (r.m31 - r.m13) * temp;
        q.z = (r.m12 - r.m21) * temp;
    }
    else
    {
        if(r.m11 > r.m22 && r.m11 > r.m33)
        {
            temp = 2.0f * sqrtf(1.0f + r.m11 - r.m22 - r.m33);
            q.w = (r.m32 - r.m23) / temp;
            q.x = 0.25f * temp;
            q.y = (r.m12 + r.m21) / temp;
            q.z = (r.m13 + r.m31) / temp;
        }
        else if( r.m22 > r.m33)
        {
            temp = 2.0f * sqrtf(1.0f + r.m22 - r.m11 - r.m33);
            q.w = (r.m13 - r.m31) / temp;
            q.x = (r.m12 + r.m21) / temp;
            q.y =  0.25f * temp;
            q.z = (r.m23 + r.m32) / temp;
        }
        else
        {
            temp = 2.0f * sqrtf(1.0f + r.m33 - r.m11 - r.m22);
            q.w = (r.m21 - r.m12) / temp;
            q.x = (r.m13 + r.m31) / temp;
            q.y = (r.m23 + r.m32) / temp;
            q.z = 0.25f * temp;
        }
    }
}

void main()
{
    float m1[9] = {0.01551372092999463200, 0.99884343581246959000, -0.04550950666890610900,
        0.99922238739871228000 ,-0.01713749902859566800 ,-0.03550952897832390700,
        -0.03624837905512174500, -0.04492323298011671700, -0.99833258894743582000};
    rotMatrix rm1;
    rm1.m11 = m1[0];
    rm1.m12 = m1[1];
    rm1.m13 = m1[2];
    rm1.m21 = m1[3];
    rm1.m22 = m1[4];
    rm1.m23 = m1[5];
    rm1.m31 = m1[6];
    rm1.m32 = m1[7];
    rm1.m33 = m1[8];
   
    Quaternion q1;
   
    rotMatrixToQuternion(q1, rm1);
    cout<<q1.x<<" "<<q1.y<<" "<<q1.z<<" "<<q1.w<<endl;


    float m2[9] = {0.01614490437974924100, 0.99884677638989772000, -0.04521569813768747100,
        0.99856922398083869000, -0.01380176413826810800, 0.05166252244109931900,
        0.05097888759941932700, -0.04598509108593063600, -0.99764047853770654000};
    rotMatrix rm2;
    rm2.m11 = m2[0];
    rm2.m12 = m2[1];
    rm2.m13 = m2[2];
    rm2.m21 = m2[3];
    rm2.m22 = m2[4];
    rm2.m23 = m2[5];
    rm2.m31 = m2[6];
    rm2.m32 = m2[7];
    rm2.m33 = m2[8];
   
    Quaternion q2;
   
    rotMatrixToQuternion(q2, rm2);
    cout<<q2.x<<" "<<q2.y<<" "<<q2.z<<" "<<q2.w<<endl;
}


posted on 2008-12-29 11:03 noBugnoGain 閱讀(2401) 評論(1)  編輯 收藏 引用 所屬分類: 基于圖像的建模

評論:
# re: 旋轉矩陣轉換為四元數 2009-05-24 13:25 | 貔貅
謝謝博主,學習了  回復  更多評論
  
青青草原综合久久大伊人导航_色综合久久天天综合_日日噜噜夜夜狠狠久久丁香五月_热久久这里只有精品
  • <ins id="pjuwb"></ins>
    <blockquote id="pjuwb"><pre id="pjuwb"></pre></blockquote>
    <noscript id="pjuwb"></noscript>
          <sup id="pjuwb"><pre id="pjuwb"></pre></sup>
            <dd id="pjuwb"></dd>
            <abbr id="pjuwb"></abbr>
            欧美日韩一区二区在线播放| 亚洲欧美日本日韩| 欧美大片专区| 亚洲国产成人精品视频| 免费成人你懂的| 欧美不卡在线视频| 一本大道久久a久久精二百| 最新国产拍偷乱拍精品| 欧美黄网免费在线观看| 亚洲一区二区毛片| 香蕉成人久久| 亚洲国产精品va在看黑人| 亚洲精品1区2区| 欧美视频在线观看一区| 久久精品视频在线观看| 蜜桃久久精品一区二区| 国产精品99久久不卡二区 | 狠狠久久综合婷婷不卡| 美国成人直播| 欧美日韩成人综合在线一区二区| 亚洲伊人网站| 久久免费精品视频| 亚洲专区一区二区三区| 欧美一区二区在线| 亚洲久久在线| 欧美在线999| 日韩视频精品在线| 欧美主播一区二区三区美女 久久精品人 | 久久免费视频在线| 久久久久久91香蕉国产| 欧美激情影音先锋| 欧美一区成人| 欧美成人一品| 久久成人精品| 欧美精品色综合| 久久国产精品99久久久久久老狼| 欧美国产日韩一区二区在线观看 | 国产精品二区在线观看| 蜜臀91精品一区二区三区| 欧美久久电影| 欧美成人一区在线| 国产一区二区三区免费在线观看 | 久久精品国产亚洲一区二区三区| 欧美成人午夜| 久久亚洲欧美| 国产免费成人在线视频| 一本色道久久加勒比精品| 在线观看av不卡| 亚洲一区影音先锋| 亚洲主播在线观看| 欧美另类极品videosbest最新版本| 久久精品国产成人| 国产精品久久久久久久久婷婷| 亚洲片区在线| 亚洲国产一区二区三区高清| 性欧美暴力猛交69hd| 亚洲欧美日韩综合| 欧美日韩一区在线播放| 亚洲精品免费在线| 亚洲美女91| 欧美成人一区二区三区在线观看| 美女视频黄 久久| 在线观看欧美| 久久人人看视频| 久热精品视频在线观看| 国产性猛交xxxx免费看久久| 欧美一级久久| 久久久久久网| 国产揄拍国内精品对白| 欧美一区视频在线| 久久久蜜臀国产一区二区| 国产一区导航| 久久精品国产一区二区三区免费看| 欧美在线观看一二区| 国产一区二区主播在线| 欧美在线观看网址综合| 久久婷婷av| 亚洲第一中文字幕| 男人的天堂亚洲在线| 亚洲国产欧美不卡在线观看| 亚洲老司机av| 欧美系列精品| 午夜在线精品偷拍| 另类图片综合电影| 91久久视频| 欧美午夜精品久久久久久超碰| 在线视频你懂得一区二区三区| 亚洲一区二区视频在线| 国产精品香蕉在线观看| 久久gogo国模啪啪人体图| 免费观看在线综合| 一区二区三区国产精华| 国产欧美va欧美va香蕉在| 欧美在线综合| 亚洲三级影院| 99天天综合性| 亚洲影视在线播放| 国内精品免费在线观看| 欧美成人情趣视频| 99精品视频一区| 麻豆精品精华液| 一本色道久久88综合日韩精品| 国产精品揄拍一区二区| 蜜臀91精品一区二区三区| 99国产精品久久久久久久| 久久精品国产2020观看福利| 亚洲乱码精品一二三四区日韩在线| 欧美性大战久久久久久久| 久久成人人人人精品欧| 亚洲人成绝费网站色www| 亚欧成人在线| 亚洲乱码国产乱码精品精可以看 | 欧美伊人久久大香线蕉综合69| 欧美成人精品h版在线观看| 亚洲影视中文字幕| 亚洲欧洲日本mm| 国产亚洲福利一区| 欧美人与禽猛交乱配视频| 久久精品女人| 先锋资源久久| 99精品欧美一区二区蜜桃免费| 美女精品国产| 久久精品视频网| 午夜精品视频在线观看一区二区| 亚洲黄色毛片| 在线观看国产精品网站| 国产美女精品一区二区三区| 欧美色欧美亚洲另类七区| 欧美成人中文字幕| 久久网站热最新地址| 久久国产欧美精品| 亚洲欧美日韩天堂一区二区| 亚洲精品免费看| 亚洲高清一区二| 欧美二区视频| 久久综合久久综合久久| 久久久久久亚洲综合影院红桃| 亚洲网站在线播放| 99精品欧美一区二区三区综合在线 | 亚洲美女黄色片| 亚洲国产成人在线播放| 免费影视亚洲| 麻豆九一精品爱看视频在线观看免费| 欧美一区=区| 欧美一级片一区| 久久精品一区二区三区四区| 欧美主播一区二区三区| 午夜精品福利在线| 午夜精品理论片| 小黄鸭精品密入口导航| 欧美一级久久| 久久精品国产免费| 久久久噜久噜久久综合| 狂野欧美一区| 欧美护士18xxxxhd| 91久久精品美女| 亚洲理论电影网| 一区二区精品在线观看| 亚洲色无码播放| 性久久久久久久| 久久综合五月| 欧美日本中文字幕| 国产精品国产三级国产专播品爱网| 国产精品chinese| 国产欧美日韩综合| 一区二区在线视频| 日韩一级不卡| 久久国产精品久久久久久久久久| 久久午夜激情| 欧美高清视频一区| 一本久道久久久| 欧美紧缚bdsm在线视频| 99精品欧美一区二区三区| 99热这里只有成人精品国产| 99精品久久久| 欧美一区二区在线| 猛干欧美女孩| 国产精品久久久亚洲一区| 国产日韩在线视频| 亚洲精品午夜| 亚洲欧美在线aaa| 卡通动漫国产精品| 亚洲欧洲在线观看| 性色av一区二区三区| 欧美成人精品三级在线观看| 国产精品久久久对白| 亚洲国产精品一区在线观看不卡 | 国产精品乱码一区二三区小蝌蚪| 国产一区再线| 亚洲一区在线观看免费观看电影高清| 久久精品国产v日韩v亚洲| 亚洲免费大片| 久久久精彩视频| 国产精品久久| 亚洲高清视频一区| 久久激五月天综合精品| 亚洲人午夜精品免费| 久久久综合网站| 国产精品理论片| 在线一区二区日韩|