[kinect] 编写多线程启动

参考
created by Dejavu


  • 多线程启动kinect可以方便的提取图像和深度数据
    调用的方式如下,是不是非常简洁
#include "imgStream.h"

int main() {
    DataStream data;
    //后面放你的图像处理类
}

需要查看的主要类

class DataStream {
private:
    Freenect::Freenect freenect;
    MyFreenectDevice& device;
    static void* getPthreadImg(void*);

public:
    Mutex imgLock;//---------线程锁,图像处理时要调用他来防止访问冲突-----
    cv::Mat color;//----------可供外部调用--------
    cv::Mat depth;//---------可供外部调用--------
    bool getImg();
    void run_thread();

    DataStream() : device(freenect.createDevice<MyFreenectDevice>(0)) {
        device.startVideo();
        device.startDepth();
        run_thread();
    }
    ~DataStream() {
        device.stopVideo();
        device.stopDepth();
    }
};
  • 码源
    imgStream.h
#ifndef _IMGSTREAM_H
#define _IMGSTREAM_H

#include "libfreenect.hpp"
#include <iostream>
#include <vector>
#include <cmath>
#include <pthread.h>
#include <opencv2/opencv.hpp>

using namespace std;

typedef unsigned short US;



class Mutex {
private:
    pthread_mutex_t m_mutex;

public:
    Mutex() {pthread_mutex_init(&m_mutex, NULL);}
    void lock() {pthread_mutex_lock(&m_mutex);}
    void unlock() {pthread_mutex_unlock(&m_mutex);}

    class ScopedLock
    {
        private:
            Mutex &_mutex;

    public:
        ScopedLock(Mutex &mutex) : _mutex(mutex) {_mutex.lock();}
        ~ScopedLock() {_mutex.unlock();}
    };
};


class MyFreenectDevice : public Freenect::FreenectDevice {
private:
        Mutex m_rgb_mutex;
        Mutex m_depth_mutex;
        cv::Mat rgbMat;
        cv::Mat depthMat;
        bool m_new_rgb_frame;
        bool m_new_depth_frame;

public:
    MyFreenectDevice(freenect_context *_ctx, int _index)
            : Freenect::FreenectDevice(_ctx, _index),
                rgbMat(cv::Size(640,480),CV_8UC3,cv::Scalar::all(0)),
                depthMat(cv::Size(640,480),CV_16UC1),
                m_new_rgb_frame(false), m_new_depth_frame(false)
    {setDepthFormat(FREENECT_DEPTH_REGISTERED);}
    void VideoCallback(void *_rgb, uint32_t timestamp);
    void DepthCallback(void *_depth, uint32_t timestamp);
    bool getRGB(cv::Mat &buffer);
    bool getDepth(cv::Mat &buffer);

};


class DataStream {
private:
    Freenect::Freenect freenect;
  MyFreenectDevice& device;
    static void* getPthreadImg(void*);

public:
    Mutex imgLock;
    cv::Mat color;
    cv::Mat depth;
    bool getImg();
    void run_thread();

    DataStream() : device(freenect.createDevice<MyFreenectDevice>(0)) {
        device.startVideo();
    device.startDepth();
        run_thread();
    }
    ~DataStream() {
        device.stopVideo();
    device.stopDepth();
    }
};


#endif

kinect_lib.cpp

#include "imgStream.h"

void MyFreenectDevice::VideoCallback(void *_rgb, uint32_t timestamp) {
        Mutex::ScopedLock lock(m_rgb_mutex);
        uint8_t* rgb = static_cast<uint8_t*>(_rgb);
        rgbMat.data = rgb;
        m_new_rgb_frame = true;
}
// Do not call directly, even in child
void MyFreenectDevice::DepthCallback(void *_depth, uint32_t timestamp) {
        Mutex::ScopedLock lock(m_depth_mutex);
        uint16_t* depth = static_cast<uint16_t*>(_depth);
        depthMat.data = (uchar*) depth;
        m_new_depth_frame = true;
}

bool MyFreenectDevice::getRGB(cv::Mat &buffer) {
        Mutex::ScopedLock lock(m_rgb_mutex);
        if (!m_new_rgb_frame)
                        return false;

        cv::cvtColor(rgbMat, buffer, CV_RGB2BGR);
        m_new_rgb_frame = false;
        return true;
}

bool MyFreenectDevice::getDepth(cv::Mat &buffer) {
        Mutex::ScopedLock lock(m_depth_mutex);
        if (!m_new_depth_frame)
                return false;

        buffer = depthMat.clone();
        m_new_depth_frame = false;

        return true;
}


bool DataStream::getImg() {
    Mutex::ScopedLock lock(imgLock);
    device.getRGB(color);
    device.getDepth(depth);
    cv::imshow("src",color);
    if(char(cv::waitKey(1)) == 27) return false;
    return true;
}

void* DataStream::getPthreadImg( void* __this ) {
    DataStream* _this = (DataStream*) __this;
    while(true) {
        if(!_this->getImg()) pthread_exit(NULL);
    }
}


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

推荐阅读更多精彩内容