videomux.cc

Go to the documentation of this file.

#include "videomux.h"
#include <algorithm>

using namespace std;

VideoMux::VideoMux (
  const Id&             n,
 
  In<VYApixel>&         CinF0,
  In<VYAimageWidth>&    imgWidthInF0,
  In<VYAimageHeight>&   imgHeightInF0,
  In<imagePosition>&    imgPosInF0,

  In<VYApixel>&         CinF1,
  In<VYAimageWidth>&    imgWidthInF1,
  In<VYAimageHeight>&   imgHeightInF1,
  In<imagePosition>&    imgPosInF1,

  Out<VYApixel>&        CoutF,
  Out<VYAimageWidth>&   imgWidthOutF,
  Out<VYAimageHeight>&  imgHeightOutF)
:
  Process(n),

  CinP0(id("CinP0"), CinF0),
  imgWidthInP0(id("imgWidthInP0"), imgWidthInF0),
  imgHeightInP0(id("imgHeightInP0"), imgHeightInF0),
  imgPosInP0(id("imgPosInP0"), imgPosInF0),

  CinP1(id("CinP1"), CinF1),
  imgWidthInP1(id("imgWidthInP1"), imgWidthInF1),
  imgHeightInP1(id("imgHeightInP1"), imgHeightInF1),
  imgPosInP1(id("imgPosInP1"), imgPosInF1),

  CoutP(id("CoutP"), CoutF),
  imgWidthOutP(id("imgWidthOutP"), imgWidthOutF),
  imgHeightOutP(id("imgHeightOutP"), imgHeightOutF)
{
}

const char* VideoMux::type() const
{
        return "VideoMux";
}

void VideoMux::main()
{
  /* N is the number of input streams */
  /* Index N+1 contains the output stream dimensions */
  
  const unsigned int N = 2;
  
  imagePosition   imgPos[N];
  VYApixel*   line[N+1] = { 0, 0, 0 };
  VYAimageWidth   imgWidth[N+1] = { 0, 0, 0 };
  VYAimageHeight  imgHeight[N+1] = { 0, 0, 0 };

  VYAimageWidth   prevImgWidth[N+1] = { 0, 0, 0 };
  
  unsigned int  mapToDepth[N];
      
  while(true)
  {
    for(unsigned int i=0; i<=N; i++)
    {
      imgWidth[i] = 0;
      imgHeight[i] = 0;
    }
  
    read(imgPosInP0, imgPos[0]);
    if (imgPos[0].enabled)
    {
      read(imgWidthInP0, imgWidth[0]);
      read(imgHeightInP0, imgHeight[0]);  
    }
    read(imgPosInP1, imgPos[1]);
    if (imgPos[1].enabled)
    {
      read(imgWidthInP1, imgWidth[1]);
      read(imgHeightInP1, imgHeight[1]);
    }
    
    for(unsigned int i=0; i<N; i++)
    {
      imgWidth[N] = max(imgWidth[N], imgPos[i].x + imgWidth[i]);
      imgHeight[N] = max(imgHeight[N], imgPos[i].y + imgHeight[i]);
    }
    write(imgWidthOutP, imgWidth[N]);
    write(imgHeightOutP, imgHeight[N]);

    for(unsigned int i=0; i<=N; i++)
    {
      if (imgWidth[i] != prevImgWidth[i])
      {
        if (!line[i]) delete [] line[i];
        line[i] = new VYApixel[imgWidth[i]];
        prevImgWidth[i] = imgWidth[i];
        
      }
    }

    for(unsigned int i=0; i<N; i++)
    {
      mapToDepth[i] = i;
    }
    for(unsigned int i=0; i<N-1; i++)
    {
      for (unsigned int j=i; j<N; j++)
      {
        if (imgPos[mapToDepth[i]].z > imgPos[mapToDepth[j]].z)
        {
          mapToDepth[i] = j;
          mapToDepth[j] = i;
        }
      }
    }
    
    for(VYAimageHeight h=0; h<imgHeight[N]; h++)
    {
      /*  If we allow read with port reference, we do not need line buffers 0..N.
        Input of length imgWidth[mi] can be read immediately in line[N][imgPos[mi].x],
        i.e.,
      
        for (unsigned int i=0; i<N; i++)
        {
          unsigned int mi = mapToDepth[i];
          if ((imgPos[mi].y<=h) && (h<imgHeight[mi]+imgPos[mi].y))
          {
            read(CinP[mi], &line[N][imgPos[mi].x], imgWidth[mi]);
          } 
        }
      */
      if ((imgPos[0].y<=h) && (h<imgHeight[0]+imgPos[0].y) && imgPos[0].enabled)
      {
        read(CinP0, &line[0][0], imgWidth[0]);
      }
      if ((imgPos[1].y<=h) && (h<imgHeight[1]+imgPos[1].y) && imgPos[1].enabled)
      {
        read(CinP1, &line[1][0], imgWidth[1]);
      }

      for(unsigned int i=0; i<imgWidth[N]; i++)
      {
        line[N][i] = 0;
      }
            
      for (unsigned int i=0; i<N; i++)
      {
        unsigned int mi = mapToDepth[i];
        if ((imgPos[mi].y<=h) && (h<imgHeight[mi]+imgPos[mi].y) && imgPos[mi].enabled)
        {
          for(unsigned j=0; j<imgWidth[mi]; j++)
          {
            line[N][imgPos[mi].x+j] = line[mi][j];
          }
        }
      }
      
      write(CoutP, &line[N][0], imgWidth[N]);
    }   
  }
}

---