tds642evm图像处理程序

/* * Copyright 2003 by Texas Instruments Incorporated. * All rights reserved. Property of Texas Instruments Incorporated. * Restricted rights to use, duplicate or disclose this code are * granted through contract. * */ /* "@(#) DDK 1.10.00.23 07-02-03 (ddk-b12)" */ #include <std.h> #include <tsk.h> #include <sem.h> #include <gio.h> #include <csl_dat.h> #include <csl_cache.h> #include <csl.h> #include <csl_edma.h> #include <sys.h> #include <log.h> #include "fvid.h" #include "edc.h" #include "vport.h" #include "vportcap.h" #include "vportdis.h" #include "saa7105.h" #include "saa7115.h" #include <evmdm642.h> #include "colorbar.h" #include "evmdm642_vcapparams.h" #include "evmdm642_vdisparams.h" unsigned char Y1[720*576]; unsigned char CB1[720*288]; unsigned char CR1[720*288]; /* heap IDs defined in the BIOS configuration file */ extern Int EXTERNALHEAP; FVID_Handle disChan; FVID_Handle capChan; FVID_Frame *capFrameBuf=NULL; FVID_Frame *disFrameBuf=NULL; Int numLinesDis=0 ; Int numLinesCap=0; Int numLines=0 ; Int numPixels =0; Int capLinePitch=0 ; Int disLinePitch=0 ; void myImageProcess(); void generateColorLine(); int histgram[360]; /* * ======== main ======== */ main() { /******************************************************/ /* open CSL DAT module for fast copy */ /******************************************************/ CSL_init(); CACHE_clean(CACHE_L2ALL, 0, 0); CACHE_setL2Mode(CACHE_256KCACHE); CACHE_enableCaching(CACHE_EMIFA_CE00); CACHE_enableCaching(CACHE_EMIFA_CE01); DAT_open(DAT_CHAANY, DAT_PRI_LOW, DAT_OPEN_2D); } /* * ======== tskVideoCAPTURE ======== * video CAPTURE function. */ void tskVideoCapture() { Int status; Int frames = 0; numLinesDis = EVMDM642_vDisParamsChan.imgVSizeFld1; numLinesCap = EVMDM642_vCapParamsChan.fldYStop1 - EVMDM642_vCapParamsChan.fldYStrt1+1; numLines = (numLinesDis > numLinesCap) ? numLinesCap : numLinesDis; // char mLaplacian[3*3]={ -1,-1,-1, -1,9,-1,-1,-1,-1}; #ifdef _CAPTURE numPixels = EVMDM642_vCapParamsChan.fldXStop1 - EVMDM642_vCapParamsChan.fldXStrt1+1; capLinePitch = EVMDM642_vCapParamsChan.fldXStop1 - EVMDM642_vCapParamsChan.fldXStrt1+1; disLinePitch = EVMDM642_vDisParamsChan.imgHSizeFld1; #endif numLines *= 2; /* both fields */ /******************************************************/ /* allocate both capture and display frame buffers */ /* in external heap memory */ /******************************************************/ EVMDM642_vCapParamsChan.segId = EXTERNALHEAP; EVMDM642_vDisParamsChan.segId = EXTERNALHEAP; EVMDM642_vDisParamsSAA7105.hI2C = EVMDM642_I2C_hI2C; EVMDM642_vCapParamsSAA7115.hI2C = EVMDM642_I2C_hI2C; /******************************************************/ /* initialization of capture driver */ /******************************************************/ #ifdef _CAPTURE capChan = FVID_create("/VP0CAPTURE/A/0", IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL); #endif /******************************************************/ /* initialization of display driver */ /******************************************************/ disChan = FVID_create("/VP2DISPLAY", IOM_OUTPUT, &status, (Ptr)&EVMDM642_vDisParamsChan, NULL); /******************************************************/ /* configure video encoder & decoder */ /******************************************************/ FVID_control(disChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, (Ptr)&EVMDM642_vDisParamsSAA7105); #ifdef _CAPTURE FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, (Ptr)&EVMDM642_vCapParamsSAA7115); #endif /******************************************************/ /* start capture & display operation */ /******************************************************/ FVID_control(disChan, VPORT_CMD_START, NULL); #ifdef _CAPTURE FVID_control(capChan, VPORT_CMD_START, NULL); #endif /********************************************************/ /* request a frame buffer from display & capture driver */ /********************************************************/ FVID_alloc(disChan, &disFrameBuf); #ifdef _CAPTURE FVID_alloc(capChan, &capFrameBuf); #endif frames ++; while(1) {/* loop forever */ #ifdef _CAPTURE #ifdef _PROCESS myImageProcess(); #else for(i = 0; i < numLines; i ++) { DAT_copy(capFrameBuf->frame.iFrm.y1 + i * capLinePitch, disFrameBuf->frame.iFrm.y1 + i * disLinePitch, numPixels); DAT_copy(capFrameBuf->frame.iFrm.cb1 + i * (capLinePitch >> 1), disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1), numPixels>>1); DAT_copy(capFrameBuf->frame.iFrm.cr1 + i * (capLinePitch >> 1), disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1), numPixels>>1); } #endif DAT_wait(DAT_XFRID_WAITALL); FVID_exchange(capChan, &capFrameBuf); #else fillFrmBuf(&disFrameBuf->frame.iFrm, EVMDM642_vDisParamsChan.imgHSizeFld1, EVMDM642_vDisParamsChan.imgVSizeFld1 + EVMDM642_vDisParamsChan.imgVSizeFld2, frames % 360); #endif CACHE_clean(CACHE_L2ALL,NULL,NULL); FVID_exchange(disChan, &disFrameBuf); frames ++; } } void myImageProcess() { Uint32 i=0,ii; float j=0; Uint8 * temp_address1; for(i = 0; i < numLines; i ++) { DAT_copy(capFrameBuf->frame.iFrm.y1 + i * capLinePitch, disFrameBuf->frame.iFrm.y1 + i * disLinePitch, numPixels>>1); DAT_copy(capFrameBuf->frame.iFrm.cb1 + i * (capLinePitch >> 1), disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1), numPixels>>2); DAT_copy(capFrameBuf->frame.iFrm.cr1 + i * (capLinePitch >> 1), disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1), numPixels>>2); } temp_address1=(Uint8 *)capFrameBuf->frame.iFrm.y1;//capFrameBuf->frame.rpFrm.buf;//&InBufferY[0]; for(i=0;i<360;i++) histgram[i]=0; for(i=0;i<numLines;i++) for (ii=0;ii<360;ii++) { histgram[ii]=histgram[ii]+temp_address1[i*disLinePitch+ii]; } j=0; for(i=0;i<360;i++) { if(histgram[i]>j) j=histgram[i]; } for(i=0;i<360;i++) { histgram[i]=(int)((float)histgram[i]/j* numLines/2); } generateColorLine(); } void generateColorLine() { Int i; Int k; for (i=0;i<360;i++) { for (k=0;k<numLines;k++) { if (((numLines-k) <= histgram[i])) //&& (i<256)) { disFrameBuf->frame.iFrm.y1[k*720+360+i] = RED_Y; /* if (i%2==0) { disFrameBuf->frame.iFrm.cb1[k*360+180+i/2] = RED_CB; disFrameBuf->frame.iFrm.cr1[k*360+180+i/2] = RED_CR; } */ } else { disFrameBuf->frame.iFrm.y1[k*720+360+i] = WHITE_Y; /*