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
00013 if(fbg!=NULL) {
00014 numLayers=numChannels=0;
00015 setNumImages(fbg->getNumLayers(),fbg->getNumChannels());
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
00023 if(fbg!=NULL) {
00024 numLayers=numChannels=0;
00025 setNumImages(fbg->getNumLayers(),fbg->getNumChannels());
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 ) {
00118 if(nLayers==numLayers && 1==numChannels)
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
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])
00165 return;
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
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
00191
00192
00193
00194
00195
00196
00197
00198
00199
00200