/*****************************************************************************
 * Copyright (C) 2013-2020 MulticoreWare, Inc
 *
 * Authors: Steve Borho <steve@borho.org>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02111, USA.
 *
 * This program is also available under a commercial proprietary license.
 * For more information, contact us at license @ x265.com.
 *****************************************************************************/

#include "common.h"
#include "output.h"
#include "y4m.h"

using namespace X265_NS;
using namespace std;

Y4MOutput::Y4MOutput(const char* filename, int w, int h, uint32_t bitdepth, uint32_t fpsNum, uint32_t fpsDenom, int csp, int inputdepth)
    : width(w)
    , height(h)
    , bitDepth(bitdepth)
    , colorSpace(csp)
    , frameSize(0)
    , inputDepth(inputdepth)
{
    ofs.open(filename, ios::binary | ios::out);
    buf = new char[width];

    const char *cf = (csp >= X265_CSP_I444) ? "444" : (csp >= X265_CSP_I422) ? "422" : "420";

    if (ofs)
    {
        if (bitDepth == 10)
            ofs << "YUV4MPEG2 W" << width << " H" << height << " F" << fpsNum << ":" << fpsDenom << " Ip" << " C" << cf << "p10" << " XYSCSS = " << cf << "P10" << "\n";
        else if (bitDepth == 12)
            ofs << "YUV4MPEG2 W" << width << " H" << height << " F" << fpsNum << ":" << fpsDenom << " Ip" << " C" << cf << "p12" << " XYSCSS = " << cf << "P12" << "\n";
        else
            ofs << "YUV4MPEG2 W" << width << " H" << height << " F" << fpsNum << ":" << fpsDenom << " Ip" << " C" << cf << "\n";

        header = ofs.tellp();
    }

    for (int i = 0; i < x265_cli_csps[colorSpace].planes; i++)
        frameSize += (uint32_t)((width >> x265_cli_csps[colorSpace].width[i]) * (height >> x265_cli_csps[colorSpace].height[i]));
}

Y4MOutput::~Y4MOutput()
{
    ofs.close();
    delete [] buf;
}

bool Y4MOutput::writePicture(const x265_picture& pic)
{
    std::ofstream::pos_type outPicPos = header;
    if (pic.bitDepth > 8)
        outPicPos += (uint64_t)(pic.poc * (6 + frameSize * 2));
    else
        outPicPos += (uint64_t)pic.poc * (6 + frameSize);
    ofs.seekp(outPicPos);
    ofs << "FRAME\n";

    if (inputDepth > 8)
    {
        if (pic.bitDepth == 8 && pic.poc == 0)
            x265_log(NULL, X265_LOG_WARNING, "y4m: down-shifting reconstructed pixels to 8 bits\n");
    }

    X265_CHECK(pic.colorSpace == colorSpace, "invalid chroma subsampling\n");

    if (inputDepth > 8)//if HIGH_BIT_DEPTH
    {
        if (pic.bitDepth == 8)
        {
            // encoder gave us short pixels, downshift, then write
            X265_CHECK(pic.bitDepth == 8, "invalid bit depth\n");
            int shift = pic.bitDepth - 8;
            for (int i = 0; i < x265_cli_csps[colorSpace].planes; i++)
            {
                char *src = (char*)pic.planes[i];
                for (int h = 0; h < height >> x265_cli_csps[colorSpace].height[i]; h++)
                {
                    for (int w = 0; w < width >> x265_cli_csps[colorSpace].width[i]; w++)
                        buf[w] = (char)(src[w] >> shift);

                    ofs.write(buf, width >> x265_cli_csps[colorSpace].width[i]);
                    src += pic.stride[i] / sizeof(*src);
                }
            }
        }
        else
        {
            X265_CHECK(pic.bitDepth > 8, "invalid bit depth\n");
            for (int i = 0; i < x265_cli_csps[colorSpace].planes; i++)
            {
                uint16_t *src = (uint16_t*)pic.planes[i];
                for (int h = 0; h < (height * 1) >> x265_cli_csps[colorSpace].height[i]; h++)
                {
                    ofs.write((const char*)src, (width * 2) >> x265_cli_csps[colorSpace].width[i]);
                    src += pic.stride[i] / sizeof(*src);
                }
            }
        }
    }
    else if (inputDepth == 8 && pic.bitDepth > 8)
    {
        X265_CHECK(pic.bitDepth > 8, "invalid bit depth\n");
        for (int i = 0; i < x265_cli_csps[colorSpace].planes; i++)
        {
            uint16_t* src = (uint16_t*)pic.planes[i];
            for (int h = 0; h < (height * 1) >> x265_cli_csps[colorSpace].height[i]; h++)
            {
                ofs.write((const char*)src, (width * 2) >> x265_cli_csps[colorSpace].width[i]);
                src += pic.stride[i] / sizeof(*src);
            }
        }
    }
    else
    {
        X265_CHECK(pic.bitDepth == 8, "invalid bit depth\n");
        for (int i = 0; i < x265_cli_csps[colorSpace].planes; i++)
        {
            char *src = (char*)pic.planes[i];
            for (int h = 0; h < height >> x265_cli_csps[colorSpace].height[i]; h++)
            {
                ofs.write(src, width >> x265_cli_csps[colorSpace].width[i]);
                src += pic.stride[i] / sizeof(*src);
            }
        }
    }

    return true;
}