思享工具箱

bayer, yuv, RGB转换方法

摘要：
网上找了很久也没找到格式转换工具，最后放弃了，觉得还是写个转换工具比较快。

http://blog.csdn.net/kickxxx/article/details/6642888

因为我的STVxxx USB camera输出格式是bayer格式，手头上只有YUVTOOLS这个查看工具，没法验证STVxxx在开发板上是否正常工作。

网上找了很久也没找到格式转换工具，最后放弃了，觉得还是写个转换工具比较快。抄写了部分libv4lconvert的代码, 我只验证了

V4L2_PIX_FMT_SGBRG8到V4L2_PIX_FMT_YUV420的转换。

bayer.c

##################################################################################

  1. /*
  2. *lib4lconvert,video4linux2formatconversionlib
  3. *(C)2008HansdeGoede<hdegoede@redhat.com>
  4. *
  5. *Thislibraryisfreesoftware;youcanredistributeitand/or
  6. *modifyitunderthetermsoftheGNULesserGeneralPublic
  7. *LicenseaspublishedbytheFreeSoftwareFoundation;either
  8. *version2.1oftheLicense,or(atyouroption)anylaterversion.
  9. *
  10. *Thislibraryisdistributedinthehopethatitwillbeuseful,
  11. *butWITHOUTANYWARRANTY;withouteventheimpliedwarrantyof
  12. *MERCHANTABILITYorFITNESSFORAPARTICULARPURPOSE.SeetheGNU
  13. *LesserGeneralPublicLicenseformoredetails.
  14. *
  15. *YoushouldhavereceivedacopyoftheGNULesserGeneralPublic
  16. *Licensealongwiththislibrary;ifnot,writetotheFreeSoftware
  17. *Foundation,Inc.,51FranklinStreet,Suite500,Boston,MA02110-1335USA
  18. *
  19. *Note:originalbayer_to_bgr24codefrom:
  20. *1394-BasedDigitalCameraControlLibrary
  21. *
  22. *Bayerpatterndecodingfunctions
  23. *
  24. *WrittenbyDamienDouxchampsandFredericDevernay
  25. *
  26. *Notethattheoriginalbayer.cinlibdc1394supportsmanydifferent
  27. *bayerdecodealgorithms,forlib4lconverttheoneinthisfilehasbeen
  28. *chosen(andoptimizedabit)andtheotheralgorithm'shavebeenremoved,
  29. *seebayer.cfromlibdc1394forallsupportedalgorithms
  30. */
  32. #include<string.h>
  33. #include<linux/videodev2.h>
  34. #include<stdio.h>
  36. #include"convert.h"
  39. /**************************************************************
  40. *Colorconversionfunctionsforcamerasthatcan*
  41. *outputraw-Bayerpatternimages,suchassomeBaslerand*
  42. *PointGreycamera.Mostofthealgospresentedherecome*
  43. *fromhttp://www-ise.stanford.edu/~tingchen/andhavebeen*
  44. *convertedfromMatlabtoCandextendedtoallelementary*
  45. *patterns.*
  46. **************************************************************/
  48. /*inspiredbyOpenCV'sBayerdecoding*/
  49. staticvoidv4lconvert_border_bayer_line_to_bgr24(
  50. constunsignedchar*bayer,constunsignedchar*adjacent_bayer,
  51. unsignedchar*bgr,intwidth,intstart_with_green,intblue_line)
  52. {
  53. intt0,t1;
  55. if(start_with_green){
  56. /*Firstpixel*/
  57. if(blue_line){
  58. *bgr++=bayer[1];
  59. *bgr++=bayer[0];
  60. *bgr++=adjacent_bayer[0];
  61. }else{
  62. *bgr++=adjacent_bayer[0];
  63. *bgr++=bayer[0];
  64. *bgr++=bayer[1];
  65. }
  66. /*Secondpixel*/
  67. t0=(bayer[0]+bayer[2]+adjacent_bayer[1]+1)/3;
  68. t1=(adjacent_bayer[0]+adjacent_bayer[2]+1)>>1;
  69. if(blue_line){
  70. *bgr++=bayer[1];
  71. *bgr++=t0;
  72. *bgr++=t1;
  73. }else{
  74. *bgr++=t1;
  75. *bgr++=t0;
  76. *bgr++=bayer[1];
  77. }
  78. bayer++;
  79. adjacent_bayer++;
  80. width-=2;
  81. }else{
  82. /*Firstpixel*/
  83. t0=(bayer[1]+adjacent_bayer[0]+1)>>1;
  84. if(blue_line){
  85. *bgr++=bayer[0];
  86. *bgr++=t0;
  87. *bgr++=adjacent_bayer[1];
  88. }else{
  89. *bgr++=adjacent_bayer[1];
  90. *bgr++=t0;
  91. *bgr++=bayer[0];
  92. }
  93. width--;
  94. }
  96. if(blue_line){
  97. for(;width>2;width-=2){
  98. t0=(bayer[0]+bayer[2]+1)>>1;
  99. *bgr++=t0;
  100. *bgr++=bayer[1];
  101. *bgr++=adjacent_bayer[1];
  102. bayer++;
  103. adjacent_bayer++;
  105. t0=(bayer[0]+bayer[2]+adjacent_bayer[1]+1)/3;
  106. t1=(adjacent_bayer[0]+adjacent_bayer[2]+1)>>1;
  107. *bgr++=bayer[1];
  108. *bgr++=t0;
  109. *bgr++=t1;
  110. bayer++;
  111. adjacent_bayer++;
  112. }
  113. }else{
  114. for(;width>2;width-=2){
  115. t0=(bayer[0]+bayer[2]+1)>>1;
  116. *bgr++=adjacent_bayer[1];
  117. *bgr++=bayer[1];
  118. *bgr++=t0;
  119. bayer++;
  120. adjacent_bayer++;
  122. t0=(bayer[0]+bayer[2]+adjacent_bayer[1]+1)/3;
  123. t1=(adjacent_bayer[0]+adjacent_bayer[2]+1)>>1;
  124. *bgr++=t1;
  125. *bgr++=t0;
  126. *bgr++=bayer[1];
  127. bayer++;
  128. adjacent_bayer++;
  129. }
  130. }
  132. if(width==2){
  133. /*Secondtolastpixel*/
  134. t0=(bayer[0]+bayer[2]+1)>>1;
  135. if(blue_line){
  136. *bgr++=t0;
  137. *bgr++=bayer[1];
  138. *bgr++=adjacent_bayer[1];
  139. }else{
  140. *bgr++=adjacent_bayer[1];
  141. *bgr++=bayer[1];
  142. *bgr++=t0;
  143. }
  144. /*Lastpixel*/
  145. t0=(bayer[1]+adjacent_bayer[2]+1)>>1;
  146. if(blue_line){
  147. *bgr++=bayer[2];
  148. *bgr++=t0;
  149. *bgr++=adjacent_bayer[1];
  150. }else{
  151. *bgr++=adjacent_bayer[1];
  152. *bgr++=t0;
  153. *bgr++=bayer[2];
  154. }
  155. }else{
  156. /*Lastpixel*/
  157. if(blue_line){
  158. *bgr++=bayer[0];
  159. *bgr++=bayer[1];
  160. *bgr++=adjacent_bayer[1];
  161. }else{
  162. *bgr++=adjacent_bayer[1];
  163. *bgr++=bayer[1];
  164. *bgr++=bayer[0];
  165. }
  166. }
  167. }
  169. /*Fromlibdc1394,whichonturnwasbasedonOpenCV'sBayerdecoding*/
  170. staticvoidbayer_to_rgbbgr24(constunsignedchar*bayer,
  171. unsignedchar*bgr,intwidth,intheight,unsignedintpixfmt,
  172. intstart_with_green,intblue_line)
  173. {
  174. /*renderthefirstline*/
  175. v4lconvert_border_bayer_line_to_bgr24(bayer,bayer+width,bgr,width,
  176. start_with_green,blue_line);
  177. bgr+=width*3;
  179. return;
  180. /*reduceheightby2becauseofthespecialcasetop/bottomline*/
  181. for(height-=2;height;height--){
  182. intt0,t1;
  183. /*(width-2)becauseoftheborder*/
  184. constunsignedchar*bayer_end=bayer+(width-2);
  186. if(start_with_green){
  187. /*OpenCVhasabuginthenextline,whichwas
  188. t0=(bayer[0]+bayer[width*2]+1)>>1;*/
  189. t0=(bayer[1]+bayer[width*2+1]+1)>>1;
  190. /*Writefirstpixel*/
  191. t1=(bayer[0]+bayer[width*2]+bayer[width+1]+1)/3;
  192. if(blue_line){
  193. *bgr++=t0;
  194. *bgr++=t1;
  195. *bgr++=bayer[width];
  196. }else{
  197. *bgr++=bayer[width];
  198. *bgr++=t1;
  199. *bgr++=t0;
  200. }
  202. /*Writesecondpixel*/
  203. t1=(bayer[width]+bayer[width+2]+1)>>1;
  204. if(blue_line){
  205. *bgr++=t0;
  206. *bgr++=bayer[width+1];
  207. *bgr++=t1;
  208. }else{
  209. *bgr++=t1;
  210. *bgr++=bayer[width+1];
  211. *bgr++=t0;
  212. }
  213. bayer++;
  214. }else{
  215. /*Writefirstpixel*/
  216. t0=(bayer[0]+bayer[width*2]+1)>>1;
  217. if(blue_line){
  218. *bgr++=t0;
  219. *bgr++=bayer[width];
  220. *bgr++=bayer[width+1];
  221. }else{
  222. *bgr++=bayer[width+1];
  223. *bgr++=bayer[width];
  224. *bgr++=t0;
  225. }
  226. }
  228. if(blue_line){
  229. for(;bayer<=bayer_end-2;bayer+=2){
  230. t0=(bayer[0]+bayer[2]+bayer[width*2]+
  231. bayer[width*2+2]+2)>>2;
  232. t1=(bayer[1]+bayer[width]+bayer[width+2]+
  233. bayer[width*2+1]+2)>>2;
  234. *bgr++=t0;
  235. *bgr++=t1;
  236. *bgr++=bayer[width+1];
  238. t0=(bayer[2]+bayer[width*2+2]+1)>>1;
  239. t1=(bayer[width+1]+bayer[width+3]+1)>>1;
  240. *bgr++=t0;
  241. *bgr++=bayer[width+2];
  242. *bgr++=t1;
  243. }
  244. }else{
  245. for(;bayer<=bayer_end-2;bayer+=2){
  246. t0=(bayer[0]+bayer[2]+bayer[width*2]+
  247. bayer[width*2+2]+2)>>2;
  248. t1=(bayer[1]+bayer[width]+bayer[width+2]+
  249. bayer[width*2+1]+2)>>2;
  250. *bgr++=bayer[width+1];
  251. *bgr++=t1;
  252. *bgr++=t0;
  254. t0=(bayer[2]+bayer[width*2+2]+1)>>1;
  255. t1=(bayer[width+1]+bayer[width+3]+1)>>1;
  256. *bgr++=t1;
  257. *bgr++=bayer[width+2];
  258. *bgr++=t0;
  259. }
  260. }
  262. if(bayer<bayer_end){
  263. /*writesecondtolastpixel*/
  264. t0=(bayer[0]+bayer[2]+bayer[width*2]+
  265. bayer[width*2+2]+2)>>2;
  266. t1=(bayer[1]+bayer[width]+bayer[width+2]+
  267. bayer[width*2+1]+2)>>2;
  268. if(blue_line){
  269. *bgr++=t0;
  270. *bgr++=t1;
  271. *bgr++=bayer[width+1];
  272. }else{
  273. *bgr++=bayer[width+1];
  274. *bgr++=t1;
  275. *bgr++=t0;
  276. }
  277. /*writelastpixel*/
  278. t0=(bayer[2]+bayer[width*2+2]+1)>>1;
  279. if(blue_line){
  280. *bgr++=t0;
  281. *bgr++=bayer[width+2];
  282. *bgr++=bayer[width+1];
  283. }else{
  284. *bgr++=bayer[width+1];
  285. *bgr++=bayer[width+2];
  286. *bgr++=t0;
  287. }
  288. bayer++;
  289. }else{
  290. /*writelastpixel*/
  291. t0=(bayer[0]+bayer[width*2]+1)>>1;
  292. t1=(bayer[1]+bayer[width*2+1]+bayer[width]+1)/3;
  293. if(blue_line){
  294. *bgr++=t0;
  295. *bgr++=t1;
  296. *bgr++=bayer[width+1];
  297. }else{
  298. *bgr++=bayer[width+1];
  299. *bgr++=t1;
  300. *bgr++=t0;
  301. }
  302. }
  304. /*skip2borderpixels*/
  305. bayer+=2;
  307. blue_line=!blue_line;
  308. start_with_green=!start_with_green;
  309. }
  311. /*renderthelastline*/
  312. v4lconvert_border_bayer_line_to_bgr24(bayer+width,bayer,bgr,width,
  313. !start_with_green,!blue_line);
  314. }
  316. voidv4lconvert_bayer_to_rgb24(constunsignedchar*bayer,
  317. unsignedchar*bgr,intwidth,intheight,unsignedintpixfmt)
  318. {
  319. bayer_to_rgbbgr24(bayer,bgr,width,height,pixfmt,
  320. pixfmt==V4L2_PIX_FMT_SGBRG8/*startwithgreen*/
  321. ||pixfmt==V4L2_PIX_FMT_SGRBG8,
  322. pixfmt!=V4L2_PIX_FMT_SBGGR8/*blueline*/
  323. &&pixfmt!=V4L2_PIX_FMT_SGBRG8);
  324. }
  326. voidv4lconvert_bayer_to_bgr24(constunsignedchar*bayer,
  327. unsignedchar*bgr,intwidth,intheight,unsignedintpixfmt)
  328. {
  329. bayer_to_rgbbgr24(bayer,bgr,width,height,pixfmt,
  330. pixfmt==V4L2_PIX_FMT_SGBRG8/*startwithgreen*/
  331. ||pixfmt==V4L2_PIX_FMT_SGRBG8,
  332. pixfmt==V4L2_PIX_FMT_SBGGR8/*blueline*/
  333. ||pixfmt==V4L2_PIX_FMT_SGBRG8);
  334. }
  336. staticvoidv4lconvert_border_bayer_line_to_y(
  337. constunsignedchar*bayer,constunsignedchar*adjacent_bayer,
  338. unsignedchar*y,intwidth,intstart_with_green,intblue_line)
  339. {
  340. intt0,t1;
  342. if(start_with_green){
  343. /*Firstpixel*/
  344. if(blue_line){
  345. *y++=(8453*adjacent_bayer[0]+16594*bayer[0]+
  346. 3223*bayer[1]+524288)>>15;
  347. }else{
  348. *y++=(8453*bayer[1]+16594*bayer[0]+
  349. 3223*adjacent_bayer[0]+524288)>>15;
  350. }
  351. /*Secondpixel*/
  352. t0=bayer[0]+bayer[2]+adjacent_bayer[1];
  353. t1=adjacent_bayer[0]+adjacent_bayer[2];
  354. if(blue_line)
  355. *y++=(4226*t1+5531*t0+3223*bayer[1]+524288)>>15;
  356. else
  357. *y++=(8453*bayer[1]+5531*t0+1611*t1+524288)>>15;
  358. bayer++;
  359. adjacent_bayer++;
  360. width-=2;
  361. }else{
  362. /*Firstpixel*/
  363. t0=bayer[1]+adjacent_bayer[0];
  364. if(blue_line){
  365. *y++=(8453*adjacent_bayer[1]+8297*t0+
  366. 3223*bayer[0]+524288)>>15;
  367. }else{
  368. *y++=(8453*bayer[0]+8297*t0+
  369. 3223*adjacent_bayer[1]+524288)>>15;
  370. }
  371. width--;
  372. }
  374. if(blue_line){
  375. for(;width>2;width-=2){
  376. t0=bayer[0]+bayer[2];
  377. *y++=(8453*adjacent_bayer[1]+16594*bayer[1]+
  378. 1611*t0+524288)>>15;
  379. bayer++;
  380. adjacent_bayer++;
  382. t0=bayer[0]+bayer[2]+adjacent_bayer[1];
  383. t1=adjacent_bayer[0]+adjacent_bayer[2];
  384. *y++=(4226*t1+5531*t0+3223*bayer[1]+524288)>>15;
  385. bayer++;
  386. adjacent_bayer++;
  387. }
  388. }else{
  389. for(;width>2;width-=2){
  390. t0=bayer[0]+bayer[2];
  391. *y++=(4226*t0+16594*bayer[1]+
  392. 3223*adjacent_bayer[1]+524288)>>15;
  393. bayer++;
  394. adjacent_bayer++;
  396. t0=bayer[0]+bayer[2]+adjacent_bayer[1];
  397. t1=adjacent_bayer[0]+adjacent_bayer[2];
  398. *y++=(8453*bayer[1]+5531*t0+1611*t1+524288)>>15;
  399. bayer++;
  400. adjacent_bayer++;
  401. }
  402. }
  404. if(width==2){
  405. /*Secondtolastpixel*/
  406. t0=bayer[0]+bayer[2];
  407. if(blue_line){
  408. *y++=(8453*adjacent_bayer[1]+16594*bayer[1]+
  409. 1611*t0+524288)>>15;
  410. }else{
  411. *y++=(4226*t0+16594*bayer[1]+
  412. 3223*adjacent_bayer[1]+524288)>>15;
  413. }
  414. /*Lastpixel*/
  415. t0=bayer[1]+adjacent_bayer[2];
  416. if(blue_line){
  417. *y++=(8453*adjacent_bayer[1]+8297*t0+
  418. 3223*bayer[2]+524288)>>15;
  419. }else{
  420. *y++=(8453*bayer[2]+8297*t0+
  421. 3223*adjacent_bayer[1]+524288)>>15;
  422. }
  423. }else{
  424. /*Lastpixel*/
  425. if(blue_line){
  426. *y++=(8453*adjacent_bayer[1]+16594*bayer[1]+
  427. 3223*bayer[0]+524288)>>15;
  428. }else{
  429. *y++=(8453*bayer[0]+16594*bayer[1]+
  430. 3223*adjacent_bayer[1]+524288)>>15;
  431. }
  432. }
  433. }
  435. voidv4lconvert_bayer_to_yuv420(constunsignedchar*bayer,unsignedchar*yuv,
  436. intwidth,intheight,unsignedintsrc_pixfmt,intyvu)
  437. {
  438. intblue_line=0,start_with_green=0,x,y;
  439. unsignedchar*ydst=yuv;
  440. unsignedchar*udst,*vdst;
  442. if(yvu){
  443. vdst=yuv+width*height;
  444. udst=vdst+width*height/4;
  445. }else{
  446. udst=yuv+width*height;
  447. vdst=udst+width*height/4;
  448. }
  450. printf("bayeraddress(0x%p)",bayer);
  451. /*Firstcalculatetheuandvplanes2x2pixelsatatime*/
  452. switch(src_pixfmt){
  453. caseV4L2_PIX_FMT_SBGGR8:
  454. for(y=0;y<height;y+=2){
  455. for(x=0;x<width;x+=2){
  456. intb,g,r;
  458. b=bayer[x];
  459. g=bayer[x+1];
  460. g+=bayer[x+width];
  461. r=bayer[x+width+1];
  462. *udst++=(-4878*r-4789*g+14456*b+4210688)>>15;
  463. *vdst++=(14456*r-6052*g-2351*b+4210688)>>15;
  464. }
  465. bayer+=2*width;
  466. }
  467. blue_line=1;
  468. break;
  470. caseV4L2_PIX_FMT_SRGGB8:
  471. for(y=0;y<height;y+=2){
  472. for(x=0;x<width;x+=2){
  473. intb,g,r;
  475. r=bayer[x];
  476. g=bayer[x+1];
  477. g+=bayer[x+width];
  478. b=bayer[x+width+1];
  479. *udst++=(-4878*r-4789*g+14456*b+4210688)>>15;
  480. *vdst++=(14456*r-6052*g-2351*b+4210688)>>15;
  481. }
  482. bayer+=2*width;
  483. }
  484. break;
  486. caseV4L2_PIX_FMT_SGBRG8:
  487. for(y=0;y<height;y+=2){
  488. for(x=0;x<width;x+=2){
  489. intb,g,r;
  491. g=bayer[x];
  492. b=bayer[x+1];
  493. r=bayer[x+width];
  494. g+=bayer[x+width+1];
  495. *udst++=(-4878*r-4789*g+14456*b+4210688)>>15;
  496. *vdst++=(14456*r-6052*g-2351*b+4210688)>>15;
  497. }
  498. bayer+=2*width;
  499. }
  500. blue_line=1;
  501. start_with_green=1;
  502. break;
  504. caseV4L2_PIX_FMT_SGRBG8:
  505. for(y=0;y<height;y+=2){
  506. for(x=0;x<width;x+=2){
  507. intb,g,r;
  509. g=bayer[x];
  510. r=bayer[x+1];
  511. b=bayer[x+width];
  512. g+=bayer[x+width+1];
  513. *udst++=(-4878*r-4789*g+14456*b+4210688)>>15;
  514. *vdst++=(14456*r-6052*g-2351*b+4210688)>>15;
  515. }
  516. bayer+=2*width;
  517. }
  518. start_with_green=1;
  519. break;
  520. }
  522. bayer-=width*height;
  523. printf("bayeraddress(0x%p)",bayer);
  525. /*renderthefirstline*/
  526. v4lconvert_border_bayer_line_to_y(bayer,bayer+width,ydst,width,
  527. start_with_green,blue_line);
  528. ydst+=width;
  530. printf("bayeraddress(0x%p),height(%d)",bayer,height);
  532. /*reduceheightby2becauseoftheborder*/
  533. for(height-=2;height;height--){
  534. intt0,t1;
  535. /*(width-2)becauseoftheborder*/
  536. constunsignedchar*bayer_end=bayer+(width-2);
  538. if(start_with_green){
  539. t0=bayer[1]+bayer[width*2+1];
  540. /*Writefirstpixel*/
  541. t1=bayer[0]+bayer[width*2]+bayer[width+1];
  542. if(blue_line)
  543. *ydst++=(8453*bayer[width]+5516*t1+
  544. 1661*t0+524288)>>15;
  545. else
  546. *ydst++=(4226*t0+5516*t1+
  547. 3223*bayer[width]+524288)>>15;
  549. /*Writesecondpixel*/
  550. t1=bayer[width]+bayer[width+2];
  551. if(blue_line)
  552. *ydst++=(4226*t1+16594*bayer[width+1]+
  553. 1611*t0+524288)>>15;
  554. else
  555. *ydst++=(4226*t0+16594*bayer[width+1]+
  556. 1611*t1+524288)>>15;
  557. bayer++;
  558. }else{
  559. /*Writefirstpixel*/
  560. t0=bayer[0]+bayer[width*2];
  561. if(blue_line){
  562. *ydst++=(8453*bayer[width+1]+16594*bayer[width]+
  563. 1661*t0+524288)>>15;
  564. }else{
  565. *ydst++=(4226*t0+16594*bayer[width]+
  566. 3223*bayer[width+1]+524288)>>15;
  567. }
  568. }
  570. if(blue_line){
  571. for(;bayer<=bayer_end-2;bayer+=2){
  572. t0=bayer[0]+bayer[2]+bayer[width*2]+bayer[width*2+2];
  573. t1=bayer[1]+bayer[width]+bayer[width+2]+bayer[width*2+1];
  574. *ydst++=(8453*bayer[width+1]+4148*t1+
  575. 806*t0+524288)>>15;
  577. t0=bayer[2]+bayer[width*2+2];
  578. t1=bayer[width+1]+bayer[width+3];
  579. *ydst++=(4226*t1+16594*bayer[width+2]+
  580. 1611*t0+524288)>>15;
  581. }
  582. }else{
  583. for(;bayer<=bayer_end-2;bayer+=2){
  584. t0=bayer[0]+bayer[2]+bayer[width*2]+bayer[width*2+2];
  585. t1=bayer[1]+bayer[width]+bayer[width+2]+bayer[width*2+1];
  586. *ydst++=(2113*t0+4148*t1+
  587. 3223*bayer[width+1]+524288)>>15;
  589. t0=bayer[2]+bayer[width*2+2];
  590. t1=bayer[width+1]+bayer[width+3];
  591. *ydst++=(4226*t0+16594*bayer[width+2]+
  592. 1611*t1+524288)>>15;
  593. }
  594. }
  596. if(bayer<bayer_end){
  597. /*Writesecondtolastpixel*/
  598. t0=bayer[0]+bayer[2]+bayer[width*2]+bayer[width*2+2];
  599. t1=bayer[1]+bayer[width]+bayer[width+2]+bayer[width*2+1];
  600. if(blue_line)
  601. *ydst++=(8453*bayer[width+1]+4148*t1+
  602. 806*t0+524288)>>15;
  603. else
  604. *ydst++=(2113*t0+4148*t1+
  605. 3223*bayer[width+1]+524288)>>15;
  607. /*writelastpixel*/
  608. t0=bayer[2]+bayer[width*2+2];
  609. if(blue_line){
  610. *ydst++=(8453*bayer[width+1]+16594*bayer[width+2]+
  611. 1661*t0+524288)>>15;
  612. }else{
  613. *ydst++=(4226*t0+16594*bayer[width+2]+
  614. 3223*bayer[width+1]+524288)>>15;
  615. }
  616. bayer++;
  617. }else{
  618. /*writelastpixel*/
  619. t0=bayer[0]+bayer[width*2];
  620. t1=bayer[1]+bayer[width*2+1]+bayer[width];
  621. if(blue_line)
  622. *ydst++=(8453*bayer[width+1]+5516*t1+
  623. 1661*t0+524288)>>15;
  624. else
  625. *ydst++=(4226*t0+5516*t1+
  626. 3223*bayer[width+1]+524288)>>15;
  627. }
  629. /*skip2borderpixels*/
  630. bayer+=2;
  632. blue_line=!blue_line;
  633. start_with_green=!start_with_green;
  634. }
  636. /*renderthelastline*/
  637. v4lconvert_border_bayer_line_to_y(bayer+width,bayer,ydst,width,
  638. !start_with_green,!blue_line);
  640. }

##################################################################################

convert.c

##################################################################################

  1. #include<stdio.h>
  2. #include<string.h>
  3. #include<stdlib.h>
  4. #include<fcntl.h>
  5. #include<sys/stat.h>
  6. #include<linux/videodev2.h>
  7. #include"convert.h"
  9. char*g_src_file=NULL;
  10. char*g_dest_file=NULL;
  11. intg_in_width=352;
  12. intg_in_height=292;
  14. unsignedintg_src_fmt=V4L2_PIX_FMT_SGBRG8;
  15. //unsignedintg_dest_fmt=V4L2_PIX_FMT_RGB24;
  16. unsignedintg_dest_fmt=V4L2_PIX_FMT_YUV420;
  19. intprocess_cmdline(intargc,char**argv)
  20. {
  21. inti;
  22. char*tmp;
  24. for(i=1;i<argc;i++){
  25. if(strcmp(argv[i],"-s")==0){
  26. g_src_file=argv[++i];
  27. }
  28. elseif(strcmp(argv[i],"d")==0){
  29. g_dest_file=strdup(argv[++i]);
  30. }
  31. elseif(strcmp(argv[i],"-sf")==0){
  32. tmp=argv[++i];
  33. if(strlen(tmp)==4){
  34. g_src_fmt=v4l2_fourcc(tmp[0],tmp[1],tmp[2],tmp[3]);
  35. }
  36. }
  37. elseif(strcmp(argv[i],"-df")==0){
  38. tmp=argv[++i];
  39. if(strlen(tmp)==4){
  40. g_dest_fmt=v4l2_fourcc(tmp[0],tmp[1],tmp[2],tmp[3]);
  41. }
  42. }
  43. elseif(strcmp(argv[i],"iw")==0){
  44. g_in_width=atoi(argv[++i]);
  45. }
  46. elseif(strcmp(argv[i],"ih")==0){
  47. g_in_height=atoi(argv[++i]);
  48. }
  49. }
  51. if(g_src_file&&g_dest_file==NULL){
  52. g_dest_file=malloc(256);
  53. sprintf(g_dest_file,"%s.out",g_src_file);
  54. }
  55. if(g_in_width==0||g_in_height==0){
  57. }
  58. }
  60. intget_file_size(intfd)
  61. {
  62. intret;
  63. structstatsb;
  65. ret=fstat(fd,&sb);
  66. if(ret==-1){
  67. returnret;
  68. }
  70. returnsb.st_size;
  71. }
  73. intget_bits_per_pixel(unsignedintfmt)
  74. {
  75. intret;
  77. switch(fmt){
  78. caseV4L2_PIX_FMT_RGB24:
  79. ret=24;
  80. break;
  81. caseV4L2_PIX_FMT_SBGGR8:
  82. caseV4L2_PIX_FMT_SGBRG8:
  83. caseV4L2_PIX_FMT_SGRBG8:
  84. caseV4L2_PIX_FMT_SRGGB8:
  85. ret=8;
  86. break;
  87. caseV4L2_PIX_FMT_YUV420:
  88. ret=12;
  89. break;
  90. caseV4L2_PIX_FMT_YUYV:
  91. caseV4L2_PIX_FMT_UYVY:
  92. ret=16;
  93. break;
  94. default:
  95. ret=-1;
  96. break;
  97. }
  99. returnret;
  100. }
  103. voidconvert(void*src,void*dest,intwidth,intheight,unsignedintsrc_fmt,unsignedintdest_fmt)
  104. {
  105. switch(src_fmt){
  106. caseV4L2_PIX_FMT_SGBRG8:
  107. if(dest_fmt==V4L2_PIX_FMT_RGB24){
  108. v4lconvert_bayer_to_rgb24(src,dest,width,height,src_fmt);
  109. }
  110. elseif(dest_fmt==V4L2_PIX_FMT_YUV420){
  111. v4lconvert_bayer_to_yuv420(src,dest,width,height,src_fmt,0);
  112. }
  113. break;
  114. default:
  115. break;
  116. }
  117. }
  119. intmain(intargc,char*argv[])
  120. {
  121. intret=0;
  122. intfd_src=0;
  123. intfd_dest=0;
  124. intsrc_size=0;
  125. intdest_size=0;
  126. intpix_num;
  127. void*src=NULL;
  128. void*dest=NULL;
  130. process_cmdline(argc,argv);
  131. if(g_src_file==NULL||g_dest_file==NULL){
  132. ret=-1;
  133. gotobailout;
  134. }
  136. printf("inputfile(%s),outputfile(%s) ",g_src_file,g_dest_file);
  138. fd_src=open(g_src_file,O_RDONLY);
  139. if(fd_src==-1){
  140. ret=-2;
  141. gotobailout;
  142. }
  144. fd_dest=open(g_dest_file,O_RDWR|O_CREAT,0666);
  145. if(fd_dest==-1){
  146. ret=-3;
  147. gotobailout;
  148. }
  150. src_size=get_file_size(fd_src);
  151. if(src_size==-1){
  152. ret=-4;
  153. gotobailout;
  154. }
  156. pix_num=src_size/(get_bits_per_pixel(g_src_fmt)/8);
  157. //dest_size=pix_num*get_bytes_per_pixel(g_dest_fmt);
  158. ret=get_bits_per_pixel(g_dest_fmt);
  159. dest_size=pix_num*ret/8;
  161. printf("src_size(%d),dest_size(%d) ",src_size,dest_size);
  162. src=malloc(src_size);
  163. dest=malloc(dest_size);
  164. if(src==NULL||dest==NULL){
  165. ret=-5;
  166. gotobailout;
  167. }
  169. ret=read(fd_src,src,src_size);
  170. if(ret!=src_size){
  171. ret=-6;
  172. gotobailout;
  173. }
  175. convert(src,dest,g_in_width,g_in_height,g_src_fmt,g_dest_fmt);
  177. printf("writeoutfile,size=%d ",dest_size);
  178. ret=write(fd_dest,dest,dest_size);
  179. if(ret!=dest_size){
  180. ret=-1;
  181. gotobailout;
  182. }
  184. bailout:
  185. if(src)
  186. free(src);
  187. if(dest)
  188. free(dest);
  189. if(fd_src)
  190. close(fd_src);
  191. if(fd_dest)
  192. close(fd_dest);
  193. if(g_dest_file)
  194. free(g_dest_file);
  196. printf("ret(%d) ",ret);
  197. returnret;
  198. }

##################################################################################

covert.h

##################################################################################

  1. #ifndef__LIBV4LCONVERT_PRIV_H
  2. #define__LIBV4LCONVERT_PRIV_H
  4. #defineV4L2_PIX_FMT_SRGGB8v4l2_fourcc('R','G','G','B')
  6. voidv4lconvert_bayer_to_rgb24(constunsignedchar*bayer,
  7. unsignedchar*bgr,intwidth,intheight,unsignedintpixfmt);
  9. voidv4lconvert_bayer_to_bgr24(constunsignedchar*bayer,
  10. unsignedchar*bgr,intwidth,intheight,unsignedintpixfmt);
  12. voidv4lconvert_bayer_to_yuv420(constunsignedchar*bayer,unsignedchar*yuv,
  13. intwidth,intheight,unsignedintsrc_pixfmt,intyvu);
  16. #endif/*__LIBV4LCONVERT_PRIV_H*/

##################################################################################

Makefile

##################################################################################

  1. CONVERT:=convert
  2. CFLAGS:=-static
  4. CC=gcc
  6. $(CONVERT):convert.cbayer.c
  8. $(CC)-o$@$^$(CFLAGS)
  9. clean:
  10. rm-f*.o$(CONVERT)

##################################################################################

RGB32 RGB565转换为YUV444

另外为了在PC显示framebuffer中的数据，写了一个ARGB32或者RGB565到YUV444的转换工具。利用YUVtools显示YUV444图像。

其实可以不用这么麻烦，使用ddms截屏也行。

YUV444是 Y U V分量比为4:4:4，每个像素用24bits表示。

##################################################################################

  1. #include<stdio.h>
  2. #include<string.h>
  3. #include<stdlib.h>
  4. #include<fcntl.h>
  5. #include<sys/stat.h>
  6. #include<linux/videodev2.h>
  8. char*g_src_file=NULL;
  9. char*g_dest_file=NULL;
  10. intg_in_width=720;
  11. intg_in_height=480;
  13. /*V4L2_PIX_FMT_BGR32*/
  14. //unsignedintg_src_fmt=V4L2_PIX_FMT_RGB32;
  15. unsignedintg_src_fmt=V4L2_PIX_FMT_RGB565;
  16. /*V4L2_PIX_FMT_YUYVV4L2_PIX_FMT_YVYUV4L2_PIX_FMT_UYVYV4L2_PIX_FMT_VYUY*/
  17. unsignedintg_dest_fmt=V4L2_PIX_FMT_YUV444;
  19. staticunsignedcharget_R(unsignedchar*src,unsignedintfmt)
  20. {
  21. unsignedcharR;
  23. switch(fmt){
  24. caseV4L2_PIX_FMT_RGB32:
  25. caseV4L2_PIX_FMT_BGR32:
  26. caseV4L2_PIX_FMT_RGB24:
  27. R=*(src);
  28. break;
  29. caseV4L2_PIX_FMT_RGB565:
  30. R=(*(src)&0x1F)<<3;
  31. break;
  32. caseV4L2_PIX_FMT_SBGGR8:
  33. caseV4L2_PIX_FMT_SGBRG8:
  34. caseV4L2_PIX_FMT_SGRBG8:
  35. caseV4L2_PIX_FMT_YUV420:
  36. caseV4L2_PIX_FMT_YUV444:
  37. default:
  38. R=0;
  39. break;
  40. }
  42. returnR;
  43. }
  45. staticunsignedcharget_G(unsignedchar*src,unsignedintfmt)
  46. {
  47. unsignedcharG;
  49. switch(fmt){
  50. caseV4L2_PIX_FMT_RGB32:
  51. caseV4L2_PIX_FMT_BGR32:
  52. caseV4L2_PIX_FMT_RGB24:
  53. G=*(src+1);
  54. break;
  55. caseV4L2_PIX_FMT_RGB565:
  56. G=((*(src)&0xE0)>>3)|((*(src+1)&0x07)<<5);
  57. break;
  58. caseV4L2_PIX_FMT_SBGGR8:
  59. caseV4L2_PIX_FMT_SGBRG8:
  60. caseV4L2_PIX_FMT_SGRBG8:
  61. caseV4L2_PIX_FMT_YUV420:
  62. caseV4L2_PIX_FMT_YUV444:
  63. default:
  64. G=0;
  65. break;
  66. }
  68. returnG;
  69. }
  71. staticunsignedcharget_B(unsignedchar*src,unsignedintfmt)
  72. {
  73. unsignedcharB;
  75. switch(fmt){
  76. caseV4L2_PIX_FMT_RGB32:
  77. caseV4L2_PIX_FMT_BGR32:
  78. caseV4L2_PIX_FMT_RGB24:
  79. B=*(src+2);
  80. break;
  81. caseV4L2_PIX_FMT_RGB565:
  82. B=(*(src+1)&0xF8);
  83. break;
  84. caseV4L2_PIX_FMT_SBGGR8:
  85. caseV4L2_PIX_FMT_SGBRG8:
  86. caseV4L2_PIX_FMT_SGRBG8:
  87. caseV4L2_PIX_FMT_YUV420:
  88. caseV4L2_PIX_FMT_YUV444:
  89. default:
  90. B=0;
  91. break;
  92. }
  94. returnB;
  95. }
  98. rgb2yuv(char*rgb,char*yuv)
  99. {
  100. inti,j;
  101. unsignedcharR,G,B,*y,*u,*v,*alpha;
  102. doubleRR,GG,BB;
  103. unsignedchar*src,*dest;
  105. for(i=0;i<g_in_height;i++){
  106. for(j=0;j<g_in_width;j++){
  107. src=rgb+(i*g_in_width+j)*get_bpp(g_src_fmt)/8;
  108. dest=yuv+(i*g_in_width+j)*get_bpp(g_dest_fmt)/8;
  110. R=get_R(src,g_src_fmt);
  111. G=get_G(src,g_src_fmt);
  112. B=get_B(src,g_src_fmt);
  113. /*normalizeto16..235*/
  114. RR=219*R/255+16;
  115. GG=219*G/255+16;
  116. BB=219*B/255+16;
  118. y=dest;
  119. u=dest+1;
  120. v=dest+2;
  121. //alpha=dest+3;
  123. *y=(unsignedchar)(0.2991*RR+0.5849*GG+0.1159*BB+0.5);
  124. *u=(unsignedchar)(-0.1725*RR-0.3372*GG+0.5097*BB+128.5);
  125. *v=(unsignedchar)(0.5097*RR-0.4254*GG-0.0843*BB+128.5);
  126. //*alpha=255;
  127. }
  128. }
  129. }
  131. intprocess_cmdline(intargc,char**argv)
  132. {
  133. inti;
  134. char*tmp;
  136. for(i=1;i<argc;i++){
  137. if(strcmp(argv[i],"-s")==0){
  138. g_src_file=argv[++i];
  139. }
  140. elseif(strcmp(argv[i],"-d")==0){
  141. g_dest_file=strdup(argv[++i]);
  142. }
  143. elseif(strcmp(argv[i],"-sf")==0){
  144. tmp=argv[++i];
  145. if(strlen(tmp)==4){
  146. g_src_fmt=v4l2_fourcc(tmp[0],tmp[1],tmp[2],tmp[3]);
  147. }
  148. }
  149. elseif(strcmp(argv[i],"-df")==0){
  150. tmp=argv[++i];
  151. if(strlen(tmp)==4){
  152. g_dest_fmt=v4l2_fourcc(tmp[0],tmp[1],tmp[2],tmp[3]);
  153. }
  154. }
  155. elseif(strcmp(argv[i],"iw")==0){
  156. g_in_width=atoi(argv[++i]);
  157. }
  158. elseif(strcmp(argv[i],"ih")==0){
  159. g_in_height=atoi(argv[++i]);
  160. }
  161. }
  163. if(g_src_file&&g_dest_file==NULL){
  164. g_dest_file=malloc(256);
  165. sprintf(g_dest_file,"%s.out",g_src_file);
  166. }
  167. if(g_in_width==0||g_in_height==0){
  169. }
  170. }
  172. intget_bpp(unsignedintfmt)
  173. {
  174. intret;
  176. switch(fmt){
  177. caseV4L2_PIX_FMT_RGB32:
  178. caseV4L2_PIX_FMT_BGR32:
  179. ret=32;
  180. break;
  181. caseV4L2_PIX_FMT_RGB24:
  182. ret=24;
  183. break;
  184. caseV4L2_PIX_FMT_RGB565:
  185. ret=16;
  186. break;
  187. caseV4L2_PIX_FMT_SBGGR8:
  188. caseV4L2_PIX_FMT_SGBRG8:
  189. caseV4L2_PIX_FMT_SGRBG8:
  190. ret=8;
  191. break;
  192. caseV4L2_PIX_FMT_YUV420:
  193. ret=12;
  194. break;
  195. caseV4L2_PIX_FMT_YUYV:
  196. caseV4L2_PIX_FMT_UYVY:
  197. ret=16;
  198. break;
  199. caseV4L2_PIX_FMT_YUV444:
  200. ret=24;
  201. break;
  202. default:
  203. ret=-1;
  204. break;
  205. }
  207. returnret;
  208. }
  210. main(intargc,char*argv[])
  211. {
  212. intret;
  213. intsrc_fd,dest_fd;
  214. intsrc_size,dest_size;
  215. char*src_buf;
  216. char*dest_buf;
  218. process_cmdline(argc,argv);
  219. if(g_src_file==NULL||g_dest_file==NULL){
  220. ret=-1;
  221. gotobailout;
  222. }
  224. src_fd=open(g_src_file,O_RDONLY);
  225. if(src_fd==-1){
  226. ret=-2;
  227. gotobailout;
  228. }
  230. dest_fd=open(g_dest_file,O_RDWR|O_CREAT,0666);
  231. if(dest_fd==-1){
  232. ret=-3;
  233. gotobailout;
  234. }
  236. src_size=g_in_width*g_in_height*get_bpp(g_src_fmt)/8;
  237. dest_size=g_in_width*g_in_height*get_bpp(g_dest_fmt)/8;
  239. src_buf=malloc(src_size);
  240. dest_buf=malloc(dest_size);
  242. ret=read(src_fd,src_buf,src_size);
  243. if(ret!=src_size){
  244. printf("src_size=%d,ret=%d ",src_size,ret);
  245. ret=-4;
  246. gotobailout;
  247. }
  249. rgb2yuv(src_buf,dest_buf);
  251. printf("writeoutfile,size=%d ",dest_size);
  252. ret=write(dest_fd,dest_buf,dest_size);
  253. if(ret!=dest_size){
  254. ret=-5;
  255. gotobailout;
  256. }
  258. bailout:
  259. printf("ret(%d) ",ret);
  260. returnret;
  262. }

##################################################################################

标签：#fd#rgb#yuv#v4l2 | 浏览：716 | 发布日期：

免责声明：文章转载自《bayer, yuv, RGB转换方法》仅用于学习参考。如对内容有疑问，请及时联系本站处理。

上篇关于Java类Calendar做统计时 获取日期的一些常见操作IDEA及IDEA汉化包下篇

宿迁高防，2C2G15M，22元/月；香港BGP，2C5G5M，25元/月 雨云优惠码：MjYwNzM=

相关文章

[Python之路] 使用epoll实现高并发HTTP服务器

什么是epoll 我们在  Python多种方式实现并发的Web Server 的最后使用单进程+单线程+非阻塞+长连接实现了一个可并发处理客户端连接的服务器。他的原理可以用以下的图来描述： 解释： 1.HTTP服务器是我们使用 单进程+单线程+非阻塞+长连接实现 的web服务器。 2.在实现的时候，我们创建了一个存放已接受Socket连接的列表，该列表...

Node.js 文件系统

Node.js 提供一组类似 UNIX（POSIX）标准的文件操作API。 Node.js 文件系统（fs 模块）模块中的方法均有异步和同步版本，例如读取文件内容的函数有异步的 fs.readFile() 和同步的 fs.readFileSync()。 异步的方法函数最后一个参数为回调函数，回调函数的第一个参数包含了错误信息(error)。 建议大家使用异...

颜色空间模型 与 Opencv中的HSV模型范围

颜色空间总结 RGB、HSV、YUV 什么是颜色 Wiki是这样说的：颜色或色彩是通过眼、脑和我们的生活经验所产生的一种对光的视觉效应。嗯，简单点说，颜色就是人对光的一种感觉，由大脑产生的一种感觉。感觉是一个很主观的东西，你怎么确定你看到的红色和我看到的是一样的呢？这个视频解释的很不错。我们需要先假设正常人对于同一种光产生的感觉基本是一致的，讨论才能继...

free命令常用参数详解及常用内存工具介绍

　　　　　　　free命令常用参数详解及常用内存工具介绍 　　　　　　　　　　　　　　　　　　　　　　　作者：尹正杰 版权声明：原创作品，谢绝转载！否则将追究法律责任。    一.内存空间使用状态 1>."-b"参数(以字节为单位显示内存使用情况) [root@node101.yinzhengjie.org.cn ~]# free -b...

【646】灰度图array转为RGB三通道array

　　两种方法可以实现： 通过 numpy 自己实现 通过 cv2.cvtColor 函数实现，灰度图转 RGB 　　所谓的灰度图转为三通道，就是三个通道都是一样的信息，相当于相同维度信息的重复，主要是通过 numpy.array 来实现，其实是可以通过类似广播的形式来实现。 1. 每一行赋值相同的内容 >>> a = np.zeros...

LaravelS

LaravelS LaravelS是一个胶水项目，用于快速集成Swoole到Laravel或Lumen，然后赋予它们更好的性能、更多可能性。Github 特性 内置Http/WebSocket服务器 多端口混合协议 协程 自定义进程 常驻内存 异步的事件监听 异步的任务队列 毫秒级定时任务 平滑Reload 修改代码后自动Reload 同时支持Lar...

最新文章

随机推荐

思享工具箱导航