From 2b43077d967c28fe99e1ff2b99f19e1433c710d9 Mon Sep 17 00:00:00 2001 From: houxiao <houxiao@454eff88-639b-444f-9e54-f578c98de674> Date: 星期四, 17 八月 2017 12:28:36 +0800 Subject: [PATCH] aaaaa --- VisitFace/RtspNativeCodec/app/src/main/cpp/FaceCache.cpp | 363 ++++++++++++++++++++++++++++++++++++++++++++++++--- 1 files changed, 340 insertions(+), 23 deletions(-) diff --git a/VisitFace/RtspNativeCodec/app/src/main/cpp/FaceCache.cpp b/VisitFace/RtspNativeCodec/app/src/main/cpp/FaceCache.cpp index 3b1797f..66d4a74 100644 --- a/VisitFace/RtspNativeCodec/app/src/main/cpp/FaceCache.cpp +++ b/VisitFace/RtspNativeCodec/app/src/main/cpp/FaceCache.cpp @@ -1,7 +1,7 @@ #include "FaceCache.h" #include "PipeLine.h" #include "MaterialBuffer.h" -#include "PL_SensetimeFaceTrack.h" +#include "PL_SensetimeFaceTrackMultiTrd.h" #include <logger.h> #include <Logger/src/logger.hpp> @@ -11,16 +11,23 @@ #include <vector> -#include "PbFaceList.pb.h" +#include <PbFaceList.pb.h> #include <libyuv.h> +#include <MediaHelper.h> + +//#define YUV420_TO_RGB888 1 +#define YUV420_TO_RGB565 1 +//#define YUV420_TO_ABGR8888 1 +//#define NV12_TO_ABGR8888 1 struct FcPmBreackerContext { uint8_t frameYUV[1920*1080*4]; size_t frameYUVSize; + MB_Frame::MBFType frameYUVType; - uint8_t frameRGB[1920*1080*4]; + uint8_t frameRGB[1920*1088*4]; size_t frameRGBSize; size_t width; @@ -31,7 +38,7 @@ bool dataAvailable; FcPmBreackerContext() : - frameYUV(), frameYUVSize(0), frameRGB(), frameRGBSize(0), + frameYUV(), frameYUVSize(0), frameYUVType(MB_Frame::MBFT__FIRST), frameRGB(), frameRGBSize(0), faceFeatures(), width(0), height(0), dataAvailable(false) { } @@ -46,10 +53,8 @@ faceFeatures.clear(); } - bool convertYUV420ToRGB() + bool convertYUV420ToRGB888() { -#define SUBSAMPLE(v, a) ((((v) + (a) - 1)) / (a)) - int src_height = height; int src_width = width; const uint8* src_y = (const uint8*)(frameYUV); @@ -57,13 +62,89 @@ const uint8* src_v = (const uint8*)(src_u + (src_height * src_width / 4)); libyuv::I420ToRGB24(src_y, src_width, - src_u, SUBSAMPLE(src_width, 2), - src_v, SUBSAMPLE(src_width, 2), + src_u, MH_SUBSAMPLE1(src_width, 2), + src_v, MH_SUBSAMPLE1(src_width, 2), frameRGB, 3 * src_width, src_width, src_height); frameRGBSize = src_height * src_width * 3; + + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/face-%u.rgb", ++f); + // FILE *pFile = fopen(fname, "wb"); + // fwrite(frameRGB, 1, frameRGBSize, pFile); + // fclose(pFile); + // if (f > 20)exit(0); + //} + return true; } + + bool convertYUV420ToRGB565() + { + int src_height = height; + int src_width = width; + const uint8* src_y = (const uint8*)(frameYUV); + const uint8* src_u = (const uint8*)(src_y + (src_height * src_width)); + const uint8* src_v = (const uint8*)(src_u + (src_height * src_width / 4)); + + if (frameYUVType == MB_Frame::MBFT_YUV420) + { + libyuv::I420ToRGB565(src_y, src_width, + src_u, MH_SUBSAMPLE1(src_width, 2), + src_v, MH_SUBSAMPLE1(src_width, 2), + frameRGB, 2 * src_width, + src_width, src_height); + } + else if (frameYUVType == MB_Frame::MBFT_NV12) + { + libyuv::NV12ToRGB565(src_y, src_width, + src_u, src_width, + frameRGB, 2 * src_width, + src_width, src_height); + + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/face-%u.rgb", ++f); + // FILE *pFile = fopen(fname, "wb"); + // fwrite(frameRGB, 1, frameRGBSize, pFile); + // fclose(pFile); + // if (f > 20)exit(0); + //} + } + frameRGBSize = src_height * src_width * 2; + return true; + } + + bool convertYUV420ToABGR8888() + { + int src_height = height; + int src_width = width; + const uint8* src_y = (const uint8*)(frameYUV); + const uint8* src_u = (const uint8*)(src_y + (src_height * src_width)); + const uint8* src_v = (const uint8*)(src_u + (src_height * src_width / 4)); + + libyuv::I420ToABGR(src_y, src_width, // android ARGB_8888 is ABGR + src_u, MH_SUBSAMPLE1(src_width, 2), + src_v, MH_SUBSAMPLE1(src_width, 2), + frameRGB, 4 * src_width, + src_width, src_height); + frameRGBSize = src_height * src_width * 4; + + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/face-%u.argb", ++f); + // FILE *pFile = fopen(fname, "wb"); + // fwrite(frameRGB, 1, frameRGBSize, pFile); + // fclose(pFile); + // if (f > 10)exit(0); + //} + + return true; + } }; bool fc_pm_breaker_ptr(const PipeMaterial* pm, void* args) @@ -78,12 +159,21 @@ return true; } +bool fc_pm_breaker_ptr_count(const PipeMaterial* pm, void* args) +{ + size_t* count = (size_t*)args; + + const st_ff_vect_t& faceFeatures(*(const st_ff_vect_t*)(pm->buffer)); + *count = faceFeatures.size(); + return false; +} + bool fc_pm_breaker_frame(const PipeMaterial* pm, void* args) { FcPmBreackerContext* ctx = (FcPmBreackerContext*)args; const MB_Frame* lastFrame((const MB_Frame*)(pm->buffer)); - if (lastFrame->type != MB_Frame::MBFT_YUV420) + if (lastFrame->type != MB_Frame::MBFT_YUV420 && lastFrame->type != MB_Frame::MBFT_NV12) { ctx->dataAvailable &= false; return false; @@ -96,12 +186,20 @@ } ctx->frameYUVSize = lastFrame->buffSize; + ctx->frameYUVType = lastFrame->type; ctx->width = lastFrame->width; ctx->height = lastFrame->height; memcpy(ctx->frameYUV, lastFrame->buffer, ctx->frameYUVSize); ctx->dataAvailable &= true; return true; +} + +NativeImgIdx::operator std::string() const +{ + char buf[256]; + sprintf(buf, "offset=%d, size=%d, type=%d, width=%d, height=%d", offset, size, type, width, height); + return std::string(buf); } #ifdef USE_ST_SDK @@ -133,6 +231,15 @@ return 0; } +// returns count of face +size_t FaceCache::getFaceCount(const PipeMaterial& pm) const +{ + size_t count = 0; + pm.breake(PipeMaterial::PMT_PTR, MB_Frame::MBFT__FIRST, fc_pm_breaker_ptr_count, &count); + + return count; +} + bool FaceCache::getFaceListPb(uint8_t* buffer, size_t& buffMaxSize) { FcPmBreackerContext& ctx(*(FcPmBreackerContext*)_ctx); @@ -149,36 +256,76 @@ for (int i = 0; i < ctx.faceFeatures.size(); i++) { - const FaceRect& faceRect(ctx.faceFeatures[i].rect); - cv::Mat roiMat(yMat, cv::Rect(faceRect.leftTop.x, faceRect.leftTop.y, faceRect.rightBottom.x - faceRect.leftTop.x, faceRect.rightBottom.y - faceRect.leftTop.y)); - - PbFaceList_FaceListImage pbFaceListImage; + if (! ctx.faceFeatures[i].test_face_in_cone(35.0f, 35.0f, 35.0f)) + continue; + + const PLGH_Rect& faceRect(ctx.faceFeatures[i].rect); + cv::Mat roiMat1(yMat, cv::Rect(faceRect.leftTop.X, faceRect.leftTop.Y, faceRect.width(), faceRect.height())); + cv::Mat roiMat(roiMat1.clone()); // #todo copy data should be avoid!!!! + size_t s = roiMat.total() * roiMat.elemSize(); + + PbFaceList_FaceListImage& pbFaceListImage(*(pbFaceList.add_images())); pbFaceListImage.set_idx(i); - pbFaceListImage.set_size(roiMat.elemSize()); - pbFaceListImage.set_type(PbFaceList_FaceListImage_ImageType_IT_Y); + pbFaceListImage.set_size(s); + pbFaceListImage.set_type(PbFaceList_FaceListImage_ImageType_MBFT_Y8); pbFaceListImage.set_width(roiMat.cols); pbFaceListImage.set_height(roiMat.rows); - pbFaceListImage.set_top_left_x(faceRect.leftTop.x); - pbFaceListImage.set_top_left_y(faceRect.leftTop.y); + pbFaceListImage.set_top_left_x(faceRect.leftTop.X); + pbFaceListImage.set_top_left_y(faceRect.leftTop.Y); - pbFaceListImage.add_img(roiMat.ptr(), roiMat.total() * roiMat.elemSize()); + pbFaceListImage.add_img(roiMat.ptr(), s); + + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/face-%u.yuv", ++f); + // FILE *pFile = fopen(fname, "wb"); + // fwrite(roiMat.ptr(), 1, s, pFile); + // fclose(pFile); + // if (f > 20)exit(0); + //} + + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/face-%u.yuv", ++f); + // FILE *pFile = fopen(fname, "wb"); + // const std::string* img(*pbFaceListImage.img().data()); + // fwrite(img->data(), 1, img->size(), pFile); + // fclose(pFile); + // if (f > 20)exit(0); + //} } size_t s = pbFaceList.ByteSize(); buffMaxSize = std::min(s, buffMaxSize); pbFaceList.SerializeToArray(buffer, buffMaxSize); + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/facelist-%u.pb", ++f); + // FILE *pFile = fopen(fname, "wb"); + // fwrite(buffer, 1, buffMaxSize, pFile); + // fclose(pFile); + // if (f > 10)exit(0); + //} + return buffMaxSize > 0; } + +#ifdef YUV420_TO_RGB888 bool FaceCache::getFaceListImage(std::vector<NativeImgIdx>& imgIdxes, uint8_t* buffImg, size_t& buffImgMaxSize) { FcPmBreackerContext& ctx(*(FcPmBreackerContext*)_ctx); + if (!ctx.dataAvailable) + return false; if (ctx.frameRGBSize == 0) { //#todo should optimize not convert the whole image - if (! ctx.convertYUV420ToRGB()) + if (! ctx.convertYUV420ToRGB888()) return false; } @@ -189,12 +336,13 @@ for (st_ff_vect_t::const_iterator ffiter = ctx.faceFeatures.begin(); ffiter != ctx.faceFeatures.end(); ++ffiter) { const FaceRect& faceRect(ffiter->rect); - cv::Mat roiMat(rgbMat, cv::Rect(faceRect.leftTop.x, faceRect.leftTop.y, faceRect.rightBottom.x - faceRect.leftTop.x, faceRect.rightBottom.y - faceRect.leftTop.y)); + cv::Mat roiMat1(rgbMat, cv::Rect(faceRect.leftTop.x, faceRect.leftTop.y, faceRect.width(), faceRect.height())); + cv::Mat roiMat(roiMat1.clone()); // #todo copy data should be avoid!!!! NativeImgIdx imgidx; imgidx.offset = offset; imgidx.size = roiMat.total() * roiMat.elemSize(); - imgidx.type = MB_Frame::MBFT_RGB; + imgidx.type = MB_Frame::MBFT_RGB888; imgidx.width = roiMat.cols; imgidx.height = roiMat.rows; @@ -207,10 +355,179 @@ return false; } - memcpy(buffImg + imgidx.offset, roiMat.ptr(), imgidx.size); + + uint8_t* pbuf = buffImg + imgidx.offset; + memcpy(pbuf, roiMat.ptr(), imgidx.size); + + //uint8_t* pbuf = buffImg + imgidx.offset; + //cv::Mat roiMat1(roiMat.cols, roiMat.rows, CV_8UC3, pbuf); + //pbuf[0]=123; + //roiMat.copyTo(roiMat1); + //memcpy(buffImg + imgidx.offset, roiMat.ptr(), imgidx.size); + + //uint8_t* pbuf = buffImg + imgidx.offset; + //for(size_t r = 0; r < roiMat.rows; r++) + //{ + // const uint8_t* pcol = roiMat.ptr<uint8_t>(r); + // memcpy(pbuf, pcol, roiMat.cols); + // pbuf += roiMat.cols; + //} + + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/face-%u.rgb", ++f); + // FILE *pFile = fopen(fname, "wb"); + // fwrite(pbuf, 1, imgidx.size, pFile); + // fclose(pFile); + // if (f > 20)exit(0); + //} + imgIdxes.push_back(imgidx); offset = newSize; } + buffImgMaxSize = offset; return true; } + +#elif YUV420_TO_RGB565 + +bool FaceCache::getFaceListImage(std::vector<NativeImgIdx>& imgIdxes, uint8_t* buffImg, size_t& buffImgMaxSize) +{ + FcPmBreackerContext& ctx(*(FcPmBreackerContext*)_ctx); + if (!ctx.dataAvailable) + return false; + + if (ctx.frameRGBSize == 0) + { + //#todo should optimize not convert the whole image + if (! ctx.convertYUV420ToRGB565()) + return false; + } + + imgIdxes.clear(); + size_t offset = 0; + + cv::Mat rgbMat(cv::Size(ctx.width, ctx.height), CV_16UC1, ctx.frameRGB); + for (st_ff_vect_t::const_iterator ffiter = ctx.faceFeatures.begin(); ffiter != ctx.faceFeatures.end(); ++ffiter) + { + if (! ffiter->test_face_in_cone(35.0f, 35.0f, 35.0f)) + continue; + + const PLGH_Rect& faceRect(ffiter->rect); + cv::Mat roiMat1(rgbMat, cv::Rect(faceRect.leftTop.X, faceRect.leftTop.Y, faceRect.width(), faceRect.height())); + cv::Mat roiMat(roiMat1.clone()); // #todo copy data should be avoid!!!! + + NativeImgIdx imgidx; + imgidx.offset = offset; + imgidx.size = roiMat.total() * roiMat.elemSize(); + imgidx.type = MB_Frame::MBFT_RGB565; + imgidx.width = roiMat.cols; + imgidx.height = roiMat.rows; + + const size_t newSize = imgidx.offset + imgidx.size; + + //isContinuous + if (newSize > buffImgMaxSize) + { + LOG_ERROR << "FaceCache::getFaceListImage buffImgMaxSize truncated" << LOG_ENDL; + return false; + } + + /* + uint8_t* pbuf = buffImg + imgidx.offset; + uint8_t* psrc = ctx.frameRGB + (ctx.width * faceRect.leftTop.y + faceRect.leftTop.x) * 2; + for (int row = 0; row < faceRect.height(); row++) + { + memcpy(pbuf, psrc, imgidx.width * 2); + pbuf += imgidx.width * 2; + psrc += ctx.width * 2; + } + */ + + uint8_t* pbuf = buffImg + imgidx.offset; + memcpy(pbuf, roiMat.ptr(), imgidx.size); + + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/face-%u-w%d-h%d.rgb565", ++f, imgidx.width, imgidx.height); + // FILE *pFile = fopen(fname, "wb"); + // fwrite(pbuf, 1, imgidx.size, pFile); + // fclose(pFile); + // if (f > 20)exit(0); + //} + + imgIdxes.push_back(imgidx); + offset = newSize; + } + + buffImgMaxSize = offset; + return true; +} + +#elif YUV420_TO_ABGR8888 + +bool FaceCache::getFaceListImage(std::vector<NativeImgIdx>& imgIdxes, uint8_t* buffImg, size_t& buffImgMaxSize) +{ + FcPmBreackerContext& ctx(*(FcPmBreackerContext*)_ctx); + if (!ctx.dataAvailable) + return false; + + if (ctx.frameRGBSize == 0) + { + //#todo should optimize not convert the whole image + if (! ctx.convertYUV420ToABGR8888()) + return false; + } + + imgIdxes.clear(); + size_t offset = 0; + + cv::Mat rgbMat(cv::Size(ctx.width, ctx.height), CV_8UC4, ctx.frameRGB); + for (st_ff_vect_t::const_iterator ffiter = ctx.faceFeatures.begin(); ffiter != ctx.faceFeatures.end(); ++ffiter) + { + const FaceRect& faceRect(ffiter->rect); + + cv::Mat roiMat1(rgbMat, cv::Rect(faceRect.leftTop.x, faceRect.leftTop.y, faceRect.rightBottom.x - faceRect.leftTop.x, faceRect.rightBottom.y - faceRect.leftTop.y)); + cv::Mat roiMat(roiMat1.clone()); // #todo copy data should be avoid!!!! + + NativeImgIdx imgidx; + imgidx.offset = offset; + imgidx.size = roiMat.total() * roiMat.elemSize(); + imgidx.type = MB_Frame::MBFT_ABGR8888; + imgidx.width = roiMat.cols; + imgidx.height = roiMat.rows; + + const size_t newSize = imgidx.offset + imgidx.size; + + //isContinuous + if (newSize > buffImgMaxSize) + { + LOG_ERROR << "FaceCache::getFaceListImage buffImgMaxSize truncated" << LOG_ENDL; + return false; + } + + uint8_t* pbuf = buffImg + imgidx.offset; + memcpy(pbuf, roiMat.ptr(), imgidx.size); + + //{ + // static size_t f = 0; + // char fname[50]; + // sprintf(fname, "/sdcard/face-%u-w%d-h%d.argb", ++f, imgidx.width, imgidx.height); + // FILE *pFile = fopen(fname, "wb"); + // fwrite(pbuf, 1, imgidx.size, pFile); + // fclose(pFile); + // if (f > 20)exit(0); + //} + + imgIdxes.push_back(imgidx); + offset = newSize; + } + + buffImgMaxSize = offset; + return true; +} + +#endif -- Gitblit v1.8.0