quickpreview.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165
  1. /*
  2. * Fast but bad debayer method that scales and rotates by skipping source
  3. * pixels and doesn't interpolate any values at all
  4. */
  5. #include <linux/videodev2.h>
  6. #include "quickpreview.h"
  7. /* Linear -> sRGB lookup table */
  8. static const int srgb[] = {
  9. 0, 12, 21, 28, 33, 38, 42, 46, 49, 52, 55, 58, 61, 63, 66, 68, 70,
  10. 73, 75, 77, 79, 81, 82, 84, 86, 88, 89, 91, 93, 94, 96, 97, 99, 100,
  11. 102, 103, 104, 106, 107, 109, 110, 111, 112, 114, 115, 116, 117, 118,
  12. 120, 121, 122, 123, 124, 125, 126, 127, 129, 130, 131, 132, 133, 134,
  13. 135, 136, 137, 138, 139, 140, 141, 142, 142, 143, 144, 145, 146, 147,
  14. 148, 149, 150, 151, 151, 152, 153, 154, 155, 156, 157, 157, 158, 159,
  15. 160, 161, 161, 162, 163, 164, 165, 165, 166, 167, 168, 168, 169, 170,
  16. 171, 171, 172, 173, 174, 174, 175, 176, 176, 177, 178, 179, 179, 180,
  17. 181, 181, 182, 183, 183, 184, 185, 185, 186, 187, 187, 188, 189, 189,
  18. 190, 191, 191, 192, 193, 193, 194, 194, 195, 196, 196, 197, 197, 198,
  19. 199, 199, 200, 201, 201, 202, 202, 203, 204, 204, 205, 205, 206, 206,
  20. 207, 208, 208, 209, 209, 210, 210, 211, 212, 212, 213, 213, 214, 214,
  21. 215, 215, 216, 217, 217, 218, 218, 219, 219, 220, 220, 221, 221, 222,
  22. 222, 223, 223, 224, 224, 225, 226, 226, 227, 227, 228, 228, 229, 229,
  23. 230, 230, 231, 231, 232, 232, 233, 233, 234, 234, 235, 235, 236, 236,
  24. 237, 237, 237, 238, 238, 239, 239, 240, 240, 241, 241, 242, 242, 243,
  25. 243, 244, 244, 245, 245, 245, 246, 246, 247, 247, 248, 248, 249, 249,
  26. 250, 250, 251, 251, 251, 252, 252, 253, 253, 254, 254, 255
  27. };
  28. static void quick_debayer_set_dst(uint8_t *dst, uint8_t p0, uint8_t p1,
  29. uint8_t p2)
  30. {
  31. dst[0] = p0;
  32. dst[1] = p1;
  33. dst[2] = p2;
  34. }
  35. void quick_debayer(const uint8_t *source, uint8_t *destination,
  36. uint32_t pix_fmt, int width, int height, int skip,
  37. int blacklevel)
  38. {
  39. int fragmentsize = 4;
  40. int byteskip = fragmentsize * skip;
  41. int input_size = width * height;
  42. int i = 0, j = 0;
  43. int row_left = width;
  44. switch (pix_fmt) {
  45. case V4L2_PIX_FMT_SBGGR8:
  46. case V4L2_PIX_FMT_SGBRG8:
  47. case V4L2_PIX_FMT_SGRBG8:
  48. case V4L2_PIX_FMT_SRGGB8:
  49. break;
  50. case V4L2_PIX_FMT_SBGGR10P:
  51. case V4L2_PIX_FMT_SGBRG10P:
  52. case V4L2_PIX_FMT_SGRBG10P:
  53. case V4L2_PIX_FMT_SRGGB10P:
  54. fragmentsize = 4;
  55. byteskip = fragmentsize * skip;
  56. break;
  57. }
  58. do {
  59. uint8_t b0 = srgb[source[i] - blacklevel];
  60. uint8_t b1 = srgb[source[i + 1] - blacklevel];
  61. uint8_t b2 = srgb[source[i + width + 1] - blacklevel];
  62. uint8_t b3 = srgb[source[i + 2] - blacklevel];
  63. uint8_t b4 = srgb[source[i + 3] - blacklevel];
  64. uint8_t b5 = srgb[source[i + width + 2] - blacklevel];
  65. switch (pix_fmt) {
  66. case V4L2_PIX_FMT_SBGGR8:
  67. case V4L2_PIX_FMT_SBGGR10P:
  68. quick_debayer_set_dst(&destination[j],
  69. b2, b1, b0);
  70. j += 3;
  71. quick_debayer_set_dst(&destination[j],
  72. b5, b4, b3);
  73. break;
  74. case V4L2_PIX_FMT_SGBRG8:
  75. case V4L2_PIX_FMT_SGBRG10P:
  76. quick_debayer_set_dst(&destination[j],
  77. b1, b2, b0);
  78. j += 3;
  79. quick_debayer_set_dst(&destination[j],
  80. b4, b4, b3);
  81. break;
  82. case V4L2_PIX_FMT_SGRBG8:
  83. case V4L2_PIX_FMT_SGRBG10P:
  84. quick_debayer_set_dst(&destination[j],
  85. b1, b0, b2);
  86. j += 3;
  87. quick_debayer_set_dst(&destination[j],
  88. b4, b3, b5);
  89. break;
  90. case V4L2_PIX_FMT_SRGGB8:
  91. case V4L2_PIX_FMT_SRGGB10P:
  92. /* fall through */
  93. default:
  94. quick_debayer_set_dst(&destination[j],
  95. b0, b1, b2);
  96. j += 3;
  97. quick_debayer_set_dst(&destination[j],
  98. b3, b4, b5);
  99. break;
  100. }
  101. j += 3;
  102. i = i + byteskip;
  103. row_left = row_left - byteskip;
  104. if(row_left < byteskip){
  105. i = i + row_left;
  106. row_left = width;
  107. i = i + width;
  108. i = i + (width * 2 * (skip-1));
  109. }
  110. } while (i < input_size);
  111. }
  112. // YUV 4:2:2 to RGB conversion
  113. void quick_yuv2rgb(const uint8_t *source, uint8_t *destination,
  114. uint32_t pix_fmt, int width, int height, int skip)
  115. {
  116. int stride = width * 2;
  117. int pixelsize = 4;
  118. int input_size = width * 2 * height;
  119. int i = 0, j = 0;
  120. int row_left = stride;
  121. uint8_t Y1, Y2, U, V;
  122. do {
  123. switch (pix_fmt) {
  124. case V4L2_PIX_FMT_UYVY:
  125. Y1 = source[i+1];
  126. Y2 = source[i+3];
  127. U = source[i];
  128. V = source[i+2];
  129. break;
  130. case V4L2_PIX_FMT_YUYV:
  131. Y1 = source[i];
  132. Y2 = source[i+2];
  133. U = source[i+1];
  134. V = source[i+3];
  135. break;
  136. }
  137. destination[j] = 1.164f * Y1 + 1.596f * (V - 128);
  138. destination[j+1] = 1.164f * Y1 - 0.813f * (V - 128) - 0.391f * (U - 128);
  139. destination[j+2] = 1.164f * Y1 + 2.018f * (U - 128);
  140. j += 3;
  141. destination[j] = 1.164f * Y2 + 1.596f * (V - 128);
  142. destination[j+1] = 1.164f * Y2 - 0.813f * (V - 128) - 0.391f * (U - 128);
  143. destination[j+2] = 1.164f * Y2 + 2.018f * (U - 128);
  144. j += 3;
  145. i += pixelsize * skip * 2;
  146. row_left -= (pixelsize * skip * 2);
  147. if(row_left < (pixelsize * skip * 2)){
  148. i = i + row_left;
  149. row_left = width;
  150. i = i + (stride * skip);
  151. }
  152. } while (i < input_size);
  153. }