Kinect2.0-空間長度測量

1.

鼠標左鍵按下選擇起點,拖動鼠標,左鍵放開讶迁,確定終點。

實現(xiàn)效果1

實現(xiàn)效果2

2.

在linux下使用libfreenect2開源多平臺驅動來獲取kinect2.0的傳感器信息核蘸,得到深度信息巍糯,并通過libfreenect2提供的getPointXYZ函數(shù),來得到相機坐標系中某一點的空間坐標客扎。


3.

運用鼠標操作函數(shù)(setMouseCallback)祟峦,來獲取畫面中的兩個點,并用直線將他們連接起來虐唠,通過(2)中的方法得到兩點的空間坐標:A(x1,y1,z1)搀愧,B(x2,y2,z2)惰聂。通過簡單計算疆偿,便可以求得兩點的實際距離。



4.

關鍵代碼:

    while(!protonect_shutdown)
    {
        listener.waitForNewFrame(frames);
        libfreenect2::Frame *rgb = frames[libfreenect2::Frame::Color];
        libfreenect2::Frame *depth = frames[libfreenect2::Frame::Depth];

        cv::Mat(rgb->height, rgb->width, CV_8UC4, rgb->data).copyTo(rgbmat);
        cv::Mat(depth->height, depth->width, CV_32FC1, depth->data).copyTo(depthmat);
        cv::Mat(registered.height, registered.width, CV_8UC4, registered.data).copyTo(rgbd);

        registration->apply(rgb, depth, &undistorted, &registered, true, &depth2rgb);
        cv::Mat(registered.height, registered.width, CV_8UC4, registered.data).copyTo(rgbd);

        //resize(rgbmat, dst1, Size(), c, d, INTER_NEAREST);
        inRange(depthmat,Scalar(a),Scalar(b),dst);
        //morphologyEx(dst,dst,MORPH_OPEN,kernel);
        findContours(dst,contours,hireachy,RETR_EXTERNAL,CHAIN_APPROX_SIMPLE,Point(0,0));
        if (contours.size() > 0)
        {
            double maxArea=0;
            for (int i = 0; i < contours.size(); i++)
            {
                double area = contourArea(contours[static_cast<int>(i)]);
                if (area > maxArea)
                {
                    maxArea = area;
                    rect = boundingRect(contours[static_cast<int>(i)]);
                    minEnclosingCircle(contours[static_cast<int>(i)], center, radius);
                }
            }
        }


        setMouseCallback("main",on_MouseHandle);     // 鼠標操作
        registration->getPointXYZ(&undistorted, pt11.y, pt11.x,x1, y1, z1);  // 像素坐標轉化為空間坐標
        registration->getPointXYZ(&undistorted,pt21.y,pt21.x,x2, y2, z2);

        //rectangle(rgbd, rect, Scalar(0,255,0),2);
        line(rgbd, pt11, pt21, Scalar(0,255,0));   //  劃線
        l = sqrt(pow((x1-x2),2) + pow((y1-y2),2) + pow((z1-z2),2));
        cout << "length:" << l << "m" <<endl;   // 輸出長度
        sprintf(str, "%.4lf", l);
        putText(rgbd, str1, pt21, FONT_HERSHEY_COMPLEX, 1,Scalar(0, 0, 255), 1);
        putText(rgbd, str, pt21, FONT_HERSHEY_COMPLEX, 1,Scalar(0, 0, 255), 1);

        circle(rgbd, pt11, 1, Scalar(255,255,0), 2);
        circle(rgbd, pt21, 1, Scalar(255,255,0), 2);
        cv::imshow("catch",dst);
        cv::imshow("depth", depthmat /4500.0);
        cv::imshow("main", rgbd);
 
        int key = cv::waitKey(1);
        protonect_shutdown = protonect_shutdown || (key > 0 && ((key & 0xFF) == 27)); // shutdown on escape
 
        listener.release(frames);
    }
 
    dev->stop();
    dev->close();
 
    delete registration;
 
#endif
 
    std::cout << "stop!" << std::endl;
    return 0;
}

void on_MouseHandle(int event, int x, int y, int flags, void* ustc)
{
    if (event == EVENT_LBUTTONDOWN)
    {
        Point pt1 = Point(x, y);
        pt11 = pt1;
    }
    else if (event == EVENT_LBUTTONUP)
    {

        Point pt2 = Point(x, y);
        pt21 = pt2;
    }
}

最后編輯于
?著作權歸作者所有,轉載或內容合作請聯(lián)系作者
  • 序言:七十年代末搓幌,一起剝皮案震驚了整個濱河市杆故,隨后出現(xiàn)的幾起案子,更是在濱河造成了極大的恐慌溉愁,老刑警劉巖处铛,帶你破解...
    沈念sama閱讀 216,651評論 6 501
  • 序言:濱河連續(xù)發(fā)生了三起死亡事件,死亡現(xiàn)場離奇詭異拐揭,居然都是意外死亡撤蟆,警方通過查閱死者的電腦和手機,發(fā)現(xiàn)死者居然都...
    沈念sama閱讀 92,468評論 3 392
  • 文/潘曉璐 我一進店門堂污,熙熙樓的掌柜王于貴愁眉苦臉地迎上來家肯,“玉大人,你說我怎么就攤上這事盟猖√忠拢” “怎么了换棚?”我有些...
    開封第一講書人閱讀 162,931評論 0 353
  • 文/不壞的土叔 我叫張陵,是天一觀的道長反镇。 經(jīng)常有香客問我固蚤,道長,這世上最難降的妖魔是什么歹茶? 我笑而不...
    開封第一講書人閱讀 58,218評論 1 292
  • 正文 為了忘掉前任夕玩,我火速辦了婚禮,結果婚禮上惊豺,老公的妹妹穿的比我還像新娘风秤。我一直安慰自己,他們只是感情好扮叨,可當我...
    茶點故事閱讀 67,234評論 6 388
  • 文/花漫 我一把揭開白布缤弦。 她就那樣靜靜地躺著,像睡著了一般彻磁。 火紅的嫁衣襯著肌膚如雪碍沐。 梳的紋絲不亂的頭發(fā)上,一...
    開封第一講書人閱讀 51,198評論 1 299
  • 那天衷蜓,我揣著相機與錄音累提,去河邊找鬼。 笑死磁浇,一個胖子當著我的面吹牛斋陪,可吹牛的內容都是我干的。 我是一名探鬼主播置吓,決...
    沈念sama閱讀 40,084評論 3 418
  • 文/蒼蘭香墨 我猛地睜開眼无虚,長吁一口氣:“原來是場噩夢啊……” “哼!你這毒婦竟也來了衍锚?” 一聲冷哼從身側響起友题,我...
    開封第一講書人閱讀 38,926評論 0 274
  • 序言:老撾萬榮一對情侶失蹤,失蹤者是張志新(化名)和其女友劉穎戴质,沒想到半個月后度宦,有當?shù)厝嗽跇淞掷锇l(fā)現(xiàn)了一具尸體,經(jīng)...
    沈念sama閱讀 45,341評論 1 311
  • 正文 獨居荒郊野嶺守林人離奇死亡告匠,尸身上長有42處帶血的膿包…… 初始之章·張勛 以下內容為張勛視角 年9月15日...
    茶點故事閱讀 37,563評論 2 333
  • 正文 我和宋清朗相戀三年戈抄,在試婚紗的時候發(fā)現(xiàn)自己被綠了。 大學時的朋友給我發(fā)了我未婚夫和他白月光在一起吃飯的照片后专。...
    茶點故事閱讀 39,731評論 1 348
  • 序言:一個原本活蹦亂跳的男人離奇死亡划鸽,死狀恐怖,靈堂內的尸體忽然破棺而出行贪,到底是詐尸還是另有隱情漾稀,我是刑警寧澤模闲,帶...
    沈念sama閱讀 35,430評論 5 343
  • 正文 年R本政府宣布,位于F島的核電站崭捍,受9級特大地震影響尸折,放射性物質發(fā)生泄漏。R本人自食惡果不足惜殷蛇,卻給世界環(huán)境...
    茶點故事閱讀 41,036評論 3 326
  • 文/蒙蒙 一实夹、第九天 我趴在偏房一處隱蔽的房頂上張望。 院中可真熱鬧粒梦,春花似錦亮航、人聲如沸。這莊子的主人今日做“春日...
    開封第一講書人閱讀 31,676評論 0 22
  • 文/蒼蘭香墨 我抬頭看了看天上的太陽。三九已至泄朴,卻和暖如春重抖,著一層夾襖步出監(jiān)牢的瞬間,已是汗流浹背祖灰。 一陣腳步聲響...
    開封第一講書人閱讀 32,829評論 1 269
  • 我被黑心中介騙來泰國打工钟沛, 沒想到剛下飛機就差點兒被人妖公主榨干…… 1. 我叫王不留,地道東北人局扶。 一個月前我還...
    沈念sama閱讀 47,743評論 2 368
  • 正文 我出身青樓恨统,卻偏偏與公主長得像,于是被迫代替她去往敵國和親三妈。 傳聞我的和親對象是個殘疾皇子畜埋,可洞房花燭夜當晚...
    茶點故事閱讀 44,629評論 2 354

推薦閱讀更多精彩內容