/*
 * Copyright (c) 2010-2019 Belledonne Communications SARL.
 *
 * This file is part of mediastreamer2.
 *
 * 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 3 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, see <http://www.gnu.org/licenses/>.
 */

#include "h265-nal-packer.h"
#include "h265-nal-unpacker.h"

#include "h265-utils.h"

using namespace std;

namespace mediastreamer {

H265NaluType::H265NaluType(uint8_t value) {
	if (0xc0 & value) throw out_of_range("H265 NALu type higher than 63");
	_value = value;
}

const H265NaluType H265NaluType::IdrWRadl = 19;
const H265NaluType H265NaluType::IdrNLp = 20;
const H265NaluType H265NaluType::CraNut = 21;
const H265NaluType H265NaluType::Vps = 32;
const H265NaluType H265NaluType::Sps = 33;
const H265NaluType H265NaluType::Pps = 34;
const H265NaluType H265NaluType::Ap = 48;
const H265NaluType H265NaluType::Fu = 49;

void H265NaluHeader::setLayerId(uint8_t layerId) {
	if (layerId & 0xc0) throw out_of_range("H265 layer ID wider than 6 bits");
	_layerId = layerId;
}

void H265NaluHeader::setTid(uint8_t tid) {
	if (tid & 0xf8) throw out_of_range("H265 layer ID wider than 3 bits");
	_tid = tid;
}

bool H265NaluHeader::operator==(const H265NaluHeader &h2) const {
	return _fBit == h2._fBit && _type == h2._type && _tid == h2._tid && _layerId == h2._layerId;
}

void H265NaluHeader::parse(const uint8_t *header) {
	uint16_t header2 = ntohs(*reinterpret_cast<const uint16_t *>(header));
	_tid = header2 & 0x07;
	header2 >>= 3;
	_layerId = header2 & 0x3f;
	header2 >>= 6;
	_type = header2 & 0x3f;
	header2 >>= 6;
	_fBit = (header2 != 0);
}

mblk_t *H265NaluHeader::forge() const {
	uint16_t header = _fBit ? 1 : 0;
	header <<= 6;
	header |= _type;
	header <<= 6;
	header |= _layerId;
	header <<= 3;
	header |= _tid;
	header = htons(header);

	mblk_t *newHeader = allocb(2, 0);
	*reinterpret_cast<uint16_t *>(newHeader->b_wptr) = header;
	newHeader->b_wptr += 2;
	return newHeader;
}

void H265FuHeader::parse(const uint8_t *header) {
	uint8_t header2 = *header;
	_type = header2 & 0x3f;
	header2 >>= 6;
	bool end = ((header2 & 0x01) != 0);
	header2 >>= 1;
	bool start = ((header2 & 0x01) != 0);

	if (start && end) throw invalid_argument("parsing an FU header with both start and end flags enabled");

	if (start) {
		_pos = Position::Start;
	} else if (end) {
		_pos = Position::End;
	} else {
		_pos = Position::Middle;
	}
}

mblk_t *H265FuHeader::forge() const {
	uint8_t header = (_pos == Position::Start ? 1 : 0);
	header <<= 1;
	header |= (_pos == Position::End ? 1 : 0);
	header <<= 6;
	header |= _type;

	mblk_t *newHeader = allocb(1, 0);
	*newHeader->b_wptr++ = header;
	return newHeader;
}

void H265ParameterSetsInserter::process(MSQueue *in, MSQueue *out) {
	H265NaluHeader header;
	bool isKeyFrame = false;
	while (mblk_t *m = ms_queue_get(in)) {
		header.parse(m->b_rptr);
		if (header.getType() == H265NaluType::Vps) {
			replaceParameterSet(_vps, m);
		} else if (header.getType() == H265NaluType::Sps) {
			replaceParameterSet(_sps, m);
		} else if (header.getType() == H265NaluType::Pps) {
			replaceParameterSet(_pps, m);
		} else {
			if (header.getType().isKeyFramePart()) {
				ms_message("H265ParameterSetsInserter: I-frame detected");
				isKeyFrame = true;
			}
			ms_queue_put(out, m);
		}
	}
	if (isKeyFrame) {
		mblk_t *insPoint = ms_queue_peek_first(out);
		ms_queue_insert(out, insPoint, dupmsg(_vps));
		ms_queue_insert(out, insPoint, dupmsg(_sps));
		ms_queue_insert(out, insPoint, dupmsg(_pps));
		ms_message("H265ParameterSetsInserter: parameter sets inserted");
	}
}

void H265ParameterSetsInserter::flush() {
	replaceParameterSet(_vps, nullptr);
	replaceParameterSet(_sps, nullptr);
	replaceParameterSet(_pps, nullptr);
}

H26xNaluHeader *H265ToolFactory::createNaluHeader() const {
	return new H265NaluHeader();
}

NalPacker *H265ToolFactory::createNalPacker(size_t maxPayloadType) const {
	return new H265NalPacker(maxPayloadType);
}

NalUnpacker *H265ToolFactory::createNalUnpacker() const {
	return new H265NalUnpacker();
}

H26xParameterSetsInserter *H265ToolFactory::createParameterSetsInserter() const {
	return new H265ParameterSetsInserter();
}

H26xParameterSetsStore *H265ToolFactory::createParameterSetsStore() const {
	return new H265ParameterSetsStore();
}

} // namespace mediastreamer
