display.c

/*
 * rpihddevice - VDR HD output device for Raspberry Pi
 * Copyright (C) 2014, 2015, 2016 Thomas Reufer
 *
 * 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 02110-1301 USA
 */

#include "display.h"
#include "ovgosd.h"
#include "tools.h"
#include "setup.h"

#include <vdr/tools.h>

extern "C" {
#include "interface/vmcs_host/vc_tvservice.h"
#include "interface/vmcs_host/vc_dispmanx.h"
}

#include <bcm_host.h>

cRpiDisplay* cRpiDisplay::s_instance = 0;

cRpiDisplay* cRpiDisplay::GetInstance(void)
{
	if (!s_instance)
	{
		int id = cRpiSetup::Display();
		TV_DISPLAY_STATE_T tvstate;
		if (!vc_tv_get_display_state(&tvstate))
		{
			DBG("default display is %s",
					tvstate.state & VC_HDMI_HDMI            ? "HDMI" :
					tvstate.state & VC_HDMI_DVI             ? "DVI"  :
					tvstate.state & VC_LCD_ATTACHED_DEFAULT ? "LCD"  :
							"unknown");

			// HDMI is default and enabled by plugin options
			if ((tvstate.state & (VC_HDMI_HDMI | VC_HDMI_DVI)) &&
					(id == VC_DISPLAY_TV_HDMI || id == VC_DISPLAY_DEFAULT))

				s_instance = new cRpiHDMIDisplay(id,
						tvstate.display.hdmi.width,
						tvstate.display.hdmi.height,
						tvstate.display.hdmi.frame_rate,
						tvstate.display.hdmi.aspect_ratio,
						tvstate.display.hdmi.scan_mode != 0,
						tvstate.display.hdmi.group,
						tvstate.display.hdmi.mode);
		}
		else
			ELOG("failed to get default display state!");

		if (!s_instance)
		{
			DISPMANX_DISPLAY_HANDLE_T display = vc_dispmanx_display_open(id);
			if (display)
			{
				DISPMANX_MODEINFO_T mode;
				if (vc_dispmanx_display_get_info(display, &mode) >= 0)
					s_instance = new cRpiDefaultDisplay(id,
							mode.width, mode.height, SDTV_ASPECT_4_3);

				vc_dispmanx_display_close(display);
			}
		}
		if (!s_instance)
		{
			ELOG("failed to get display information!");
			s_instance = new cRpiDefaultDisplay(id, 720, 576, SDTV_ASPECT_4_3);
		}
	}

	return s_instance;
}

void cRpiDisplay::DropInstance(void)
{
	SetHvsSyncUpdate(cScanMode::eProgressive);
	delete s_instance;
	s_instance = 0;
}

cRpiDisplay::cRpiDisplay(int id, int width, int height, int frameRate,
		int aspectRatio, bool interlaced, bool fixedMode) :
	m_id(id),
	m_width(width),
	m_height(height),
	m_frameRate(frameRate),
	m_aspectRatio(aspectRatio),
	m_interlaced(interlaced),
	m_fixedMode(fixedMode)
{
}

cRpiDisplay::~cRpiDisplay()
{
}

int cRpiDisplay::GetSize(int &width, int &height)
{
	cRpiDisplay* instance = GetInstance();
	if (instance)
	{
		width = instance->m_width;
		height = instance->m_height;
		return 0;
	}
	return -1;
}

int cRpiDisplay::GetSize(int &width, int &height, double &aspect)
{
	cRpiDisplay* instance = GetInstance();
	if (instance)
	{
		width = instance->m_width;
		height = instance->m_height;
		switch (instance->m_aspectRatio)
		{
		case HDMI_ASPECT_4_3:
			aspect = 4.0 / 3.0;
			break;
		case HDMI_ASPECT_16_9:
			aspect = 16.0 / 9.0;
			break;
		default:
			aspect = (double)width / height;
			break;
		}
		aspect /= (double)width / height;
		return 0;
	}
	return -1;
}

int cRpiDisplay::SetVideoFormat(const cVideoFrameFormat *frameFormat)
{
	cRpiDisplay* instance = GetInstance();
	if (instance)
		return instance->Update(frameFormat);

	return -1;
}

int cRpiDisplay::SetHvsSyncUpdate(cScanMode::eMode scanMode)
{
	char response[64];
	DBG("SetHvsSyncUpdate(%s)", cScanMode::Str(scanMode));
	return vc_gencmd(response, sizeof(response), "hvs_update_fields %d",
			scanMode == cScanMode::eTopFieldFirst    ? 1 :
			scanMode == cScanMode::eBottomFieldFirst ? 2 : 0);
}

bool cRpiDisplay::IsProgressive(void)
{
	cRpiDisplay* instance = GetInstance();
	if (instance)
		return !instance->m_interlaced;

	return false;
}

bool cRpiDisplay::IsFixedMode(void)
{
	cRpiDisplay* instance = GetInstance();
	if (instance)
		return instance->m_fixedMode;

	return false;
}

int cRpiDisplay::GetId(void)
{
	cRpiDisplay* instance = GetInstance();
	if (instance)
		return instance->m_id;

	return false;
}

int cRpiDisplay::Snapshot(unsigned char* frame, int width, int height)
{
	cRpiDisplay* instance = GetInstance();
	if (instance)
	{
		DISPMANX_DISPLAY_HANDLE_T display = vc_dispmanx_display_open(
				instance->m_id);

		if (display)
		{
			uint32_t image;
			DISPMANX_RESOURCE_HANDLE_T res = vc_dispmanx_resource_create(
					VC_IMAGE_RGB888, width, height, &image);

			vc_dispmanx_snapshot(display, res,
					(DISPMANX_TRANSFORM_T)(DISPMANX_SNAPSHOT_PACK));

			VC_RECT_T rect = { 0, 0, width, height };
			vc_dispmanx_resource_read_data(res, &rect, frame, width * 3);

			vc_dispmanx_resource_delete(res);
			vc_dispmanx_display_close(display);
			return 0;
		}
	}
	return -1;
}

void cRpiDisplay::GetModeFormat(const cVideoFrameFormat *format,
		int &modeX, int &modeY, int &aspectRatio)
{
	/*                |  Format   |  PAR  |   Mode    |  DAR |
	 * -------------------------------------------------------
	 * NTSC SD MPEG-2 |  720x480  |  8:9  |  720x480  |  4:3 |
	 * NTSC SD MPEG-4 |  720x480  | 10:11 |  720x480  |  4:3 |
	 * NTSC SD MPEG-2 |  720x480  | 32:27 |  720x480  | 16:9 |
	 * NTSC SD MPEG-4 |  720x480  | 40:33 |  720x480  | 16:9 |
	 * PAL  SD MPEG-2 |  720x576  | 16:15 |  720x576  |  4:3 |
	 * PAL  SD MPEG-4 |  720x576  | 12:11 |  720x576  |  4:3 |
	 * PAL  SD MPEG-2 |  720x576  | 64:45 |  720x576  | 16:9 |
	 * PAL  SD MPEG-4 |  720x576  | 16:11 |  720x576  | 16:9 |
	 *      HD        | 1280x720  |  1:1  | 1280x720  | 16:9 |
	 *      HD        | 1280x1080 |  3:2  | 1920x1080 | 16:9 |
	 *      HD        | 1920x1080 |  1:1  | 1920x1080 | 16:9 |
	 */

	aspectRatio = HDMI_ASPECT_UNKNOWN;
	modeY = format->height;

	switch (modeY)
	{
	case 480:
		if ((format->pixelWidth == 8 && format->pixelHeight == 9) ||
				(format->pixelWidth == 10 && format->pixelHeight == 11))
			aspectRatio = HDMI_ASPECT_4_3;
		else if ((format->pixelWidth == 32 && format->pixelHeight == 27) ||
				(format->pixelWidth == 40 && format->pixelHeight == 33))
			aspectRatio = HDMI_ASPECT_16_9;
		modeX = format->width;
		break;

	case 576:
		if ((format->pixelWidth == 16 && format->pixelHeight == 15) ||
				(format->pixelWidth == 12 && format->pixelHeight == 11))
			aspectRatio = HDMI_ASPECT_4_3;
		else if ((format->pixelWidth == 64 && format->pixelHeight == 45) ||
				(format->pixelWidth == 16 && format->pixelHeight == 11))
			aspectRatio = HDMI_ASPECT_16_9;
		modeX = format->width;
		break;

	default:
		ILOG("unknown video frame format: %dx%d@%d%s PAR(%d:%d)",
				format->width, format->height, format->frameRate,
				format->Interlaced() ? "i" : "p",
				format->pixelWidth, format->pixelHeight);
		break;
	case 720:
	case 1080:
		aspectRatio = HDMI_ASPECT_16_9;
		modeX = format->width *	format->pixelWidth / format->pixelHeight;
		break;
	}
}

int cRpiDisplay::Update(const cVideoFrameFormat *frameFormat)
{
	if (m_fixedMode || (
			cRpiSetup::GetVideoResolution() == cVideoResolution::eDontChange &&
			cRpiSetup::GetVideoFrameRate() == cVideoFrameRate::eDontChange))
		return 0;

	int newWidth = m_width;
	int newHeight = m_height;
	int newFrameRate = m_frameRate;
	int newAspectRatio = m_aspectRatio;
	bool newInterlaced = m_interlaced;

	switch (cRpiSetup::GetVideoResolution())
	{
	case cVideoResolution::e480:
		newWidth = 720;
		newHeight = 480;
		newAspectRatio = HDMI_ASPECT_4_3;
		break;

	case cVideoResolution::e480w:
		newWidth = 720;
		newHeight = 480;
		newAspectRatio = HDMI_ASPECT_16_9;
		break;

	case cVideoResolution::e576:
		newWidth = 720;
		newHeight = 576;
		newAspectRatio = HDMI_ASPECT_4_3;
		break;

	case cVideoResolution::e576w:
		newWidth = 720;
		newHeight = 576;
		newAspectRatio = HDMI_ASPECT_16_9;
		break;

	case cVideoResolution::e720:
		newWidth = 1280;
		newHeight = 720;
		newAspectRatio = HDMI_ASPECT_16_9;
		break;

	case cVideoResolution::e1080:
		newWidth = 1920;
		newHeight = 1080;
		newAspectRatio = HDMI_ASPECT_16_9;
		break;

	case cVideoResolution::eFollowVideo:
		GetModeFormat(frameFormat, newWidth, newHeight, newAspectRatio);
		break;

	default:
	case cVideoResolution::eDontChange:
		break;
	}

	switch (cRpiSetup::GetVideoFrameRate())
	{
	case cVideoFrameRate::e24p: newFrameRate = 24; newInterlaced = false; break;
	case cVideoFrameRate::e25p: newFrameRate = 25; newInterlaced = false; break;
	case cVideoFrameRate::e30p: newFrameRate = 30; newInterlaced = false; break;
	case cVideoFrameRate::e50i: newFrameRate = 50; newInterlaced = true;  break;
	case cVideoFrameRate::e50p: newFrameRate = 50; newInterlaced = false; break;
	case cVideoFrameRate::e60i: newFrameRate = 60; newInterlaced = true;  break;
	case cVideoFrameRate::e60p: newFrameRate = 60; newInterlaced = false; break;

	case cVideoFrameRate::eFollowVideo:
		if (frameFormat->frameRate)
		{
			newFrameRate = frameFormat->frameRate;
			newInterlaced = frameFormat->Interlaced();
		}
		break;

	default:
	case cVideoFrameRate::eDontChange:
		break;
	}

	// set new mode only if necessary
	if (newWidth != m_width || newHeight != m_height ||
			newFrameRate != m_frameRate || newInterlaced != m_interlaced ||
			newAspectRatio != m_aspectRatio)
		return SetMode(newWidth, newHeight, newFrameRate, newAspectRatio,
				newInterlaced ? frameFormat->scanMode : cScanMode::eProgressive);

	return 0;
}

const char* cRpiDisplay::AspectRatioStr(int aspectRatio)
{
	return	aspectRatio == HDMI_ASPECT_4_3   ? "4:3"   :
			aspectRatio == HDMI_ASPECT_14_9  ? "14:9"  :
			aspectRatio == HDMI_ASPECT_16_9  ? "16:9"  :
			aspectRatio == HDMI_ASPECT_5_4   ? "5:4"   :
			aspectRatio == HDMI_ASPECT_16_10 ? "16:10" :
			aspectRatio == HDMI_ASPECT_15_9  ? "15:9"  :
			aspectRatio == HDMI_ASPECT_64_27 ? "64:27" :
			aspectRatio == HDMI_ASPECT_21_9  ? "21:9"  : "unknown";
}

/* ------------------------------------------------------------------------- */

#define HDMI_MAX_MODES 64

class cRpiHDMIDisplay::ModeList {
public:

	TV_SUPPORTED_MODE_NEW_T modes[HDMI_MAX_MODES];
	int nModes;
};

cRpiHDMIDisplay::cRpiHDMIDisplay(int id, int width, int height, int frameRate,
		int aspectRatio, bool interlaced, int group, int mode) :
	cRpiDisplay(id, width, height, frameRate, aspectRatio, interlaced, false),
	m_modes(new cRpiHDMIDisplay::ModeList()),
	m_group(group),
	m_mode(mode),
	m_startGroup(group),
	m_startMode(mode),
	m_modified(false)
{
	vc_tv_register_callback(TvServiceCallback, 0);

	m_modes->nModes = vc_tv_hdmi_get_supported_modes_new(HDMI_RES_GROUP_CEA,
			m_modes->modes, HDMI_MAX_MODES, NULL, NULL);

	m_modes->nModes += vc_tv_hdmi_get_supported_modes_new(HDMI_RES_GROUP_DMT,
			&m_modes->modes[m_modes->nModes], HDMI_MAX_MODES - m_modes->nModes,
			NULL, NULL);

	if (m_modes->nModes)
	{
		DLOG("supported HDMI modes:");
		for (int i = 0; i < m_modes->nModes; i++)
		{
			DLOG("%s[%02d]: %4dx%4d@%2d%s | %*s | %3d.%03dMHz%s%s",
				m_modes->modes[i].group == HDMI_RES_GROUP_CEA ? "CEA" :
				m_modes->modes[i].group == HDMI_RES_GROUP_DMT ? "DMT" : "---",
				m_modes->modes[i].code,
				m_modes->modes[i].width,
				m_modes->modes[i].height,
				m_modes->modes[i].frame_rate,
				m_modes->modes[i].scan_mode ? "i" : "p",
				5, AspectRatioStr(m_modes->modes[i].aspect_ratio),
				m_modes->modes[i].pixel_freq / 1000000,
				m_modes->modes[i].pixel_freq % 1000000 / 1000,
				m_modes->modes[i].native ? " (native)" : "",
				m_modes->modes[i].code == m_mode &&
					m_modes->modes[i].group == m_group ? " (current)" : "");

			// update initial parameters
			if (m_modes->modes[i].code == m_mode &&
					m_modes->modes[i].group == m_group)
			{
				m_width = m_modes->modes[i].width;
				m_height = m_modes->modes[i].height;
				m_frameRate = m_modes->modes[i].frame_rate;
				m_interlaced = m_modes->modes[i].scan_mode;
			}
		}
	}
	else
		ELOG("failed to read HDMI EDID information!");

}

cRpiHDMIDisplay::~cRpiHDMIDisplay()
{
	vc_tv_unregister_callback(TvServiceCallback);

	// if mode has been changed, set back to previous state
	if (m_modified)
		SetMode(m_startGroup, m_startMode);

	delete m_modes;
}

int cRpiHDMIDisplay::SetMode(int width, int height, int frameRate,
		int aspectRatio, cScanMode::eMode scanMode)
{
	SetHvsSyncUpdate(scanMode);
	int interlaced = cScanMode::Interlaced(scanMode) ? 1 : 0;
	int mode = -1, altMode = -1;

	for (int i = 0; i < m_modes->nModes && mode == -1; i++)
	{
		if (m_modes->modes[i].width == width &&
				m_modes->modes[i].height == height &&
				m_modes->modes[i].frame_rate == frameRate &&
				m_modes->modes[i].aspect_ratio == aspectRatio &&
				m_modes->modes[i].scan_mode == interlaced)
			mode = i;

		else if (m_modes->modes[i].height == height &&
				m_modes->modes[i].frame_rate == frameRate &&
				m_modes->modes[i].aspect_ratio == aspectRatio &&
				m_modes->modes[i].scan_mode == interlaced)
			altMode = i;
	}

	if (mode == -1 && altMode != -1)
		mode = altMode;

	if (mode != -1)
	{
		m_width = m_modes->modes[mode].width;
		m_height = m_modes->modes[mode].height;
		m_frameRate = m_modes->modes[mode].frame_rate;
		m_aspectRatio = m_modes->modes[mode].aspect_ratio;
		m_interlaced = m_modes->modes[mode].scan_mode;

		DLOG("setting HDMI mode to %dx%d@%2d%s (%s)", m_width, m_height,
				m_frameRate, m_interlaced ? "i" : "p",
				AspectRatioStr(m_aspectRatio));

		return SetMode(m_modes->modes[mode].group, m_modes->modes[mode].code);
	}

	DLOG("failed to set HDMI mode to %dx%d@%2d%s (%s)",
			width, height, frameRate, interlaced ? "i" : "p",
			AspectRatioStr(aspectRatio));

	return -1;
}

int cRpiHDMIDisplay::SetMode(int group, int mode)
{
	int ret = 0;
	if (group != m_group || mode != m_mode)
	{
		DBG("cHDMI::SetMode(%s, %d)",
			group == HDMI_RES_GROUP_DMT ? "DMT" :
			group == HDMI_RES_GROUP_CEA ? "CEA" : "unknown", mode);

		ret = vc_tv_hdmi_power_on_explicit_new(HDMI_MODE_HDMI,
				(HDMI_RES_GROUP_T)group, mode);
		if (ret)
			ELOG("failed to set HDMI mode!");
		else
		{
			m_group = group;
			m_mode = mode;
			m_modified = true;
		}
	}
	return ret;
}

void cRpiHDMIDisplay::TvServiceCallback(void *data, unsigned int reason,
		unsigned int param1, unsigned int param2)
{
	if (reason & VC_HDMI_DVI + VC_HDMI_HDMI)
		cRpiOsdProvider::ResetOsd();
}

/* ------------------------------------------------------------------------- */

cRpiDefaultDisplay::cRpiDefaultDisplay(int id, int width, int height,
		int aspectRatio) :
	cRpiDisplay(id, width, height, 50, aspectRatio, false, true)
{
}