UVCCallBack.cpp 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115
  1. #include <stdio.h>
  2. #include <unistd.h>
  3. #include <sys/time.h>
  4. #include <iostream>
  5. #include <fstream>
  6. #include <vector>
  7. #include <memory>
  8. #include "../libuvc/libuvc.h"
  9. #include "UVCDeviceManager.h"
  10. #include "../DataManager/DataManager.h"
  11. #include "../DataManager/DataPackage.h"
  12. #include <opencv4/opencv2/opencv.hpp>
  13. #include <opencv4/opencv2/imgcodecs.hpp>
  14. #include "../ImageTest/ImageTest.h"
  15. struct timeval pre_frame_time;
  16. /* This callback function runs once per frame. Use it to perform any
  17. * quick processing you need, or have it put the frame into your application's
  18. * input queue. If this function takes too long, you'll start losing frames. */
  19. void cbSaveToLocal(uvc_frame_t *frame, void *ptr)
  20. {
  21. uvc_error_t ret;
  22. int *pindex = (int *)ptr;
  23. int index = *pindex;
  24. FILE *fp;
  25. static int jpeg_count[3] = {0};
  26. static int jpeg_group[3] = {0};
  27. static const char *H264_FILE = "iOSDevLog.h264";
  28. static const char *MJPEG_FILE = ".jpeg";
  29. char filename[264];
  30. std::fstream log_file("CallBackLog.txt", std::ios::app);
  31. DataPackagePtr dataPackage = nullptr;
  32. // static MemoryPool<DataPackage> dataPool(BUFFER_SIZE, 3840, 2160);
  33. std::shared_ptr<DataPipe<DataPackage>> pipe;
  34. // std::fstream readImage("./auv.jpg", std::ios::binary | std::ios::in);
  35. // if (!readImage)
  36. // {
  37. // std::cerr << "不能打开文件 example.bin" << std::endl;
  38. // }
  39. // readImage.seekg(0, std::ios::end);
  40. // std::streamsize fileSize = readImage.tellg();
  41. // readImage.seekg(0, std::ios::beg);
  42. // unsigned char *buffer = new unsigned char[fileSize];
  43. // readImage.read((char *)buffer, fileSize);
  44. // readImage.close();
  45. switch (frame->frame_format)
  46. {
  47. case UVC_FRAME_FORMAT_H264:
  48. /* use `ffplay H264_FILE` to play */
  49. fp = fopen(H264_FILE, "a");
  50. fwrite(frame->data, 1, frame->data_bytes, fp);
  51. fclose(fp);
  52. break;
  53. case UVC_COLOR_FORMAT_MJPEG:
  54. // if (!g_gpioExplorer->getFailingStatus(index))
  55. // {
  56. // // std::cout << "Pass this wave" << std::endl;
  57. // break;
  58. // }
  59. // g_gpioExplorer->resetFailingStatus(index);
  60. if(!UsbTest::SimulateTrigger::getInstance().isTriggering(index))
  61. {
  62. break;
  63. }
  64. if (jpeg_count[index] / 23 >= 1)
  65. jpeg_group[index]++;
  66. jpeg_count[index] = jpeg_count[index] % 23;
  67. std::cout << "Current File Device " << index << " UVC Index : " << jpeg_count[index] << std::endl;
  68. // sprintf(filename, "./data/%d/%d-%d%s", index, jpeg_group[index], jpeg_count[index]++, MJPEG_FILE);
  69. dataPackage = DataManager::getInstance().acquireDataBuffer<DataPackage>();
  70. memcpy(dataPackage->pJpegData, frame->data, frame->data_bytes);
  71. dataPackage->nJpegSize = frame->data_bytes;
  72. dataPackage->nWidth = frame->width;
  73. dataPackage->nHeight = frame->height;
  74. dataPackage->nTimeStamp = frame->capture_time_finished.tv_sec * 1000 + frame->capture_time_finished.tv_nsec / 1000000;
  75. dataPackage->nCameraID = index;
  76. dataPackage->dDegree = jpeg_count[index]++;
  77. //std::string logMessage = "UVC Frame Received: Device " + std::to_string(index) + " UVC Received: Degree: " + std::to_string(jpeg_count[index] - 1) + UsbTest::GlobalResolutionTimer::getInstance().pressStopWatchString();
  78. //UsbTest::TimeRecorder::getInstance().recordTime(logMessage);
  79. DataManager::getInstance().pushData<DataPackage>("uvc" + std::to_string(index), dataPackage);
  80. // fp = fopen("./Ouput4k.jpg", "w");
  81. // fwrite(frame->data, 1, frame->data_bytes, fp);
  82. // fclose(fp);
  83. break;
  84. case UVC_COLOR_FORMAT_YUYV:
  85. break;
  86. default:
  87. break;
  88. }
  89. if (frame->sequence % 30 == 0)
  90. {
  91. printf(" * got image %u\n", frame->sequence);
  92. }
  93. }
  94. // call back function
  95. void cbDoNothing(uvc_frame_t *frame, void *ptr)
  96. {
  97. printf("callback! frame_format = %d, width = %d, height = %d, length = %lu, ptr = %p\n",
  98. frame->frame_format, frame->width, frame->height, frame->data_bytes, ptr);
  99. }