Tekkotsu Homepage
Demos
Overview
Downloads
Dev. Resources
Reference
Credits

InterleavedYUVGenerator.cc

Go to the documentation of this file.
00001 #include "InterleavedYUVGenerator.h"
00002 #include "Events/EventRouter.h"
00003 #include "Events/FilterBankEvent.h"
00004 #include "Wireless/Wireless.h"
00005 #include "Shared/Profiler.h"
00006 
00007 #include "Shared/debuget.h"
00008 
00009 InterleavedYUVGenerator::InterleavedYUVGenerator(unsigned int mysid,FilterBankGenerator* fbg, EventBase::EventTypeID_t tid)
00010   : FilterBankGenerator("InterleavedYUVGenerator","InterleavedYUVGenerator",EventBase::visInterleaveEGID,mysid,fbg,tid), srcYChan(0), srcUChan(1), srcVChan(2), isAllocated(NULL)
00011 {
00012   //this part is only necessary if you override setNumImages yourself
00013   if(fbg!=NULL) {
00014     numLayers=numChannels=0; //this is to force setNumImages to override settings provided by FilterBankGenerator
00015     setNumImages(fbg->getNumLayers(),fbg->getNumChannels()); //channels gets overridden to '1' in setNumImages
00016   }
00017 }
00018 
00019 InterleavedYUVGenerator::InterleavedYUVGenerator(unsigned int mysid, unsigned int syc, unsigned int suc, unsigned int svc,FilterBankGenerator* fbg, EventBase::EventTypeID_t tid)
00020   : FilterBankGenerator("InterleavedYUVGenerator","InterleavedYUVGenerator",EventBase::visInterleaveEGID,mysid,fbg,tid), srcYChan(syc), srcUChan(suc), srcVChan(svc), isAllocated(NULL)
00021 {
00022   //this part is only necessary if you override setNumImages yourself
00023   if(fbg!=NULL) {
00024     numLayers=numChannels=0; //this is to force setNumImages to override settings provided by FilterBankGenerator
00025     setNumImages(fbg->getNumLayers(),fbg->getNumChannels()); //channels gets overridden to '1' in setNumImages
00026   }
00027 }
00028 
00029 void
00030 InterleavedYUVGenerator::processEvent(const EventBase& event) {
00031   FilterBankGenerator::processEvent(event);
00032   if(event.getGeneratorID()==getListenGeneratorID() && event.getSourceID()==getListenSourceID()) {
00033     FilterBankEvent fbkev(this,getGeneratorID(),getSourceID(),EventBase::activateETID);
00034     erouter->postEvent(fbkev);
00035     fbkev.setTypeID(EventBase::statusETID);
00036     erouter->postEvent(fbkev);
00037     fbkev.setTypeID(EventBase::deactivateETID);
00038     erouter->postEvent(fbkev);
00039   }
00040 }
00041 
00042 unsigned int
00043 InterleavedYUVGenerator::getBinSize() const {
00044   unsigned int used=FilterBankGenerator::getBinSize();
00045   used+=strlen("InterleavedYUVImage")+LoadSave::stringpad;
00046   used+=widths[selectedSaveLayer]*heights[selectedSaveLayer]*3;
00047   return used;
00048 }
00049 
00050 unsigned int
00051 InterleavedYUVGenerator::loadBuffer(const char buf[], unsigned int len) {
00052   unsigned int origlen=len;
00053   if(!checkInc(FilterBankGenerator::loadBuffer(buf,len),buf,len)) return 0;
00054   std::string tmp;
00055   if(!decodeInc(tmp,buf,len)) return 0;
00056   if(tmp!="InterleavedYUVImage") {
00057     serr->printf("Unhandled image type for InterleavedYUVGenerator: %s",tmp.c_str());
00058     return 0;
00059   } else {
00060     unsigned int used=widths[selectedSaveLayer]*heights[selectedSaveLayer]*3;
00061     if(used>len)
00062       return 0;
00063     if(images[selectedSaveLayer][selectedSaveChannel]==NULL)
00064       images[selectedSaveLayer][selectedSaveChannel]=createImageCache(selectedSaveLayer,selectedSaveChannel);
00065     unsigned char* img=images[selectedSaveLayer][selectedSaveChannel];
00066     if(img==NULL)
00067       return 0;
00068     memcpy(img,buf,used);
00069     len-=used; buf+=used;
00070     imageValids[selectedSaveLayer][selectedSaveChannel]=true;
00071     return origlen-len; 
00072   }
00073 }
00074 
00075 unsigned int
00076 InterleavedYUVGenerator::saveBuffer(char buf[], unsigned int len) const {
00077   unsigned int origlen=len;
00078   if(!checkInc(FilterBankGenerator::saveBuffer(buf,len),buf,len)) return 0;
00079   if(!encodeInc("InterleavedYUVImage",buf,len)) return 0;
00080   
00081   unsigned int used=widths[selectedSaveLayer]*heights[selectedSaveLayer]*3;
00082   if(used>len)
00083     return 0;
00084   if(images[selectedSaveLayer][selectedSaveChannel]==NULL) {
00085     serr->printf("InterleavedYUVGenerator::saveBuffer() failed because selected image is NULL -- call selectSaveImage first to make sure it's up to date\n");
00086     return 0;
00087   }
00088   if(!imageValids[selectedSaveLayer][selectedSaveChannel]) {
00089     serr->printf("InterleavedYUVGenerator::saveBuffer() failed because selected image is invalid -- call selectSaveImage first to make sure it's up to date\n");
00090     return 0;
00091   }
00092   unsigned char* img=images[selectedSaveLayer][selectedSaveChannel];
00093   if(img==NULL)
00094     return 0;
00095   memcpy(buf,img,used);
00096   len-=used;
00097   return origlen-len;
00098 }
00099 
00100 void
00101 InterleavedYUVGenerator::setDimensions() {
00102   FilterBankGenerator::setDimensions();
00103   for(unsigned int i=0; i<numLayers; i++)
00104     strides[i]=widths[i]*3;
00105 }
00106 
00107 void
00108 InterleavedYUVGenerator::destruct() {
00109   FilterBankGenerator::destruct();
00110   for(unsigned int i=0; i<numLayers; i++)
00111     delete [] isAllocated[i];
00112   delete [] isAllocated;
00113   isAllocated=NULL;
00114 }
00115 
00116 void
00117 InterleavedYUVGenerator::setNumImages(unsigned int nLayers, unsigned int /*nChannels*/) {
00118   if(nLayers==numLayers && 1==numChannels) // this generator only has 1 channel
00119     return;
00120   FilterBankGenerator::setNumImages(nLayers,1);
00121   isAllocated=new bool*[numLayers];
00122   for(unsigned int res=0; res<numLayers; res++) {
00123     increments[res]=3;
00124     isAllocated[res]=new bool[numChannels];
00125     for(unsigned int c=0; c<numChannels; c++)
00126       isAllocated[res][c]=false;
00127   }
00128 }
00129 
00130 void
00131 InterleavedYUVGenerator::freeCaches() {
00132   FilterBankGenerator::freeCaches();
00133   for(unsigned int i=0; i<numLayers; i++)
00134     for(unsigned int j=0; j<numChannels; j++)
00135       isAllocated[i][j]=false;
00136 }
00137 
00138 void
00139 InterleavedYUVGenerator::invalidateCaches() {
00140   for(unsigned int i=0; i<numLayers; i++)
00141     for(unsigned int j=0; j<numChannels; j++) {
00142       if(!isAllocated[i][j])
00143         images[i][j]=NULL;
00144       imageValids[i][j]=false;
00145     }
00146 }
00147 
00148 unsigned char *
00149 InterleavedYUVGenerator::createImageCache(unsigned int layer, unsigned int chan) const {
00150   if(src->getStride(layer)==getStride(layer) && src->getIncrement(layer)==getIncrement(layer)) {
00151     //already interleaved, pass through
00152     ASSERT(!isAllocated[layer][chan],"pass through over allocated image!")
00153     imageValids[layer][chan]=true;
00154     return src->getImage(layer,srcYChan);
00155   } else {
00156     isAllocated[layer][chan]=true;
00157     return new unsigned char[widths[layer]*heights[layer]*3];
00158   }
00159 }
00160 
00161 void
00162 InterleavedYUVGenerator::calcImage(unsigned int layer, unsigned int chan) {
00163   PROFSECTION("InterleavedYUVGenerator::calcImage(...)",*mainProfiler);
00164   if(imageValids[layer][chan]) //check if createCache set valid flag
00165     return; //indicates pass through from previous stage
00166   
00167   unsigned char* dimg=images[layer][chan];
00168   const unsigned char* syimg=src->getImage(layer,srcYChan);
00169   const unsigned char* suimg=src->getImage(layer,srcUChan);
00170   const unsigned char* svimg=src->getImage(layer,srcVChan);
00171   const unsigned int inc=src->getIncrement(layer);
00172   const unsigned int skip=src->getSkip(layer);
00173   //std::cout << src->getWidth(layer) << " inc=" << inc << " skip=" << src->getSkip(layer) << " stride=" << src->getStride(layer) << std::endl;
00174   for(unsigned int y=0; y<getHeight(layer); y++) {
00175     for(unsigned int x=0; x<getWidth(layer); x++) {
00176       *dimg++=*syimg;
00177       *dimg++=*suimg;
00178       *dimg++=*svimg;
00179       syimg+=inc;
00180       suimg+=inc;
00181       svimg+=inc;
00182     }
00183     syimg+=skip;
00184     suimg+=skip;
00185     svimg+=skip;
00186   }
00187   imageValids[layer][chan]=true;
00188 }
00189 
00190 /*! @file
00191  * @brief Implements InterleavedYUVGenerator, which generates FilterBankEvents containing raw camera images with interleaved pixels (YUVYUVYUV... instead of YYY...UUU...VVV...)
00192  * @author ejt (Creator)
00193  *
00194  * $Author: ejt $
00195  * $Name: tekkotsu-4_0 $
00196  * $Revision: 1.19 $
00197  * $State: Exp $
00198  * $Date: 2006/09/11 23:05:20 $
00199  */
00200 

Tekkotsu v4.0
Generated Thu Nov 22 00:54:53 2007 by Doxygen 1.5.4