matrix.cc

Go to the documentation of this file.

/*--------------------------------------------------------------------
 *
 * (C) Copyright Koninklijke Philips Electronics NV 2006. 
 * All rights reserved. This software is licensed under the terms of
 * version 2.1 of the GNU Lesser General Public License as published 
 * by the Free Software Foundation. For licensing and warranty
 * information, see the file COPYING in the main directory.
 *
 *------------------------------------------------------------------*/

#include "matrix.h"
#include <stdio.h>

/* Ensure number is >=0 and <=255        */
#define Saturate(n) ((n) > 0 ? ((n) < 255 ? (n) : 255) : 0)

Matrix::Matrix (
    const Id&          n,
    In<VYApixel>&      Ci1F,
    In<VYApixel>&      Ci2F,
    In<VYApixel>&      Ci3F,
    Out<VYApixel>&     Co1F,
    Out<VYApixel>&     Co2F,
    Out<VYApixel>&     Co3F)
:
    // member initialisation
    // process network
    Process(n),

    // ports
    Ci1P(id("Ci1"), Ci1F),
    Ci2P(id("Ci2"), Ci2F),
    Ci3P(id("Ci3"), Ci3F),
    Co1P(id("G_Y"), Co1F),
    Co2P(id("Co2"), Co2F),
    Co3P(id("Co3"), Co3F)
{
};

void Matrix::main(void)
{
  VYApixel Ci1,Ci2,Ci3;
  VYApixel Co1,Co2,Co3;
  
      int   y,cb,cr;
      int   rcb, rcr;
      int r,g,b;

  while(true)
  {
    read(Ci1P, Ci1);
    read(Ci2P, Ci2);
    read(Ci3P, Ci3);

    y = Ci1;
    cb = Ci2;
    cr = Ci3;

    rcb = cb-128;
    rcr = cr-128;

    r = y + ((359*rcr)>>8);
    g = y - ((11*rcb)>>5) - ((183*rcr)>>8);
    b = y + ((227*rcb)>>7);

    Co1 = Saturate(r);
    Co2 = Saturate(g);
    Co3 = Saturate(b);

    write(Co1P, Co1);
    write(Co2P, Co2);
    write(Co3P, Co3);
  }
}

---