linux/drivers/video/hdmi.c
Gwan-gyeong Mun f45ce9336f video/hdmi: Add Unpack only function for DRM infoframe
It adds an unpack only function for DRM infoframe for dynamic range and
mastering infoframe readout.
It unpacks the information data block contained in the binary buffer into
a structured frame of the HDMI Dynamic Range and Mastering (DRM)
information frame.

In contrast to hdmi_drm_infoframe_unpack() function, it does not verify
a checksum.

It can be used for unpacking a DP HDR Metadata Infoframe SDP case.
DP HDR Metadata Infoframe SDP uses the same Dynamic Range and Mastering
(DRM) information (CTA-861-G spec.) such as HDMI DRM infoframe.
But DP SDP header and payload structure are different from HDMI DRM
Infoframe. Therefore unpacking DRM infoframe for DP requires skipping of
a verifying checksum.

v9: Add clear comments to hdmi_drm_infoframe_unpack_only() and
    hdmi_drm_infoframe_unpack() (Laurent Pinchart)

Signed-off-by: Gwan-gyeong Mun <gwan-gyeong.mun@intel.com>
Reviewed-by: Uma Shankar <uma.shankar@intel.com>
Cc: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
Cc: Ville Syrjala <ville.syrjala@linux.intel.com>
Acked-by: Daniel Vetter <daniel.vetter@ffwll.ch>
Signed-off-by: Jani Nikula <jani.nikula@intel.com>
Link: https://patchwork.freedesktop.org/patch/msgid/20200514060732.3378396-2-gwan-gyeong.mun@intel.com
2020-05-14 13:50:43 +03:00

1907 lines
51 KiB
C

/*
* Copyright (C) 2012 Avionic Design GmbH
*
* Permission is hereby granted, free of charge, to any person obtaining a
* copy of this software and associated documentation files (the "Software"),
* to deal in the Software without restriction, including without limitation
* the rights to use, copy, modify, merge, publish, distribute, sub license,
* and/or sell copies of the Software, and to permit persons to whom the
* Software is furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice (including the
* next paragraph) shall be included in all copies or substantial portions
* of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
* DEALINGS IN THE SOFTWARE.
*/
#include <linux/bitops.h>
#include <linux/bug.h>
#include <linux/errno.h>
#include <linux/export.h>
#include <linux/hdmi.h>
#include <linux/string.h>
#include <linux/device.h>
#define hdmi_log(fmt, ...) dev_printk(level, dev, fmt, ##__VA_ARGS__)
static u8 hdmi_infoframe_checksum(const u8 *ptr, size_t size)
{
u8 csum = 0;
size_t i;
/* compute checksum */
for (i = 0; i < size; i++)
csum += ptr[i];
return 256 - csum;
}
static void hdmi_infoframe_set_checksum(void *buffer, size_t size)
{
u8 *ptr = buffer;
ptr[3] = hdmi_infoframe_checksum(buffer, size);
}
/**
* hdmi_avi_infoframe_init() - initialize an HDMI AVI infoframe
* @frame: HDMI AVI infoframe
*/
void hdmi_avi_infoframe_init(struct hdmi_avi_infoframe *frame)
{
memset(frame, 0, sizeof(*frame));
frame->type = HDMI_INFOFRAME_TYPE_AVI;
frame->version = 2;
frame->length = HDMI_AVI_INFOFRAME_SIZE;
}
EXPORT_SYMBOL(hdmi_avi_infoframe_init);
static int hdmi_avi_infoframe_check_only(const struct hdmi_avi_infoframe *frame)
{
if (frame->type != HDMI_INFOFRAME_TYPE_AVI ||
frame->version != 2 ||
frame->length != HDMI_AVI_INFOFRAME_SIZE)
return -EINVAL;
if (frame->picture_aspect > HDMI_PICTURE_ASPECT_16_9)
return -EINVAL;
return 0;
}
/**
* hdmi_avi_infoframe_check() - check a HDMI AVI infoframe
* @frame: HDMI AVI infoframe
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields.
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_avi_infoframe_check(struct hdmi_avi_infoframe *frame)
{
return hdmi_avi_infoframe_check_only(frame);
}
EXPORT_SYMBOL(hdmi_avi_infoframe_check);
/**
* hdmi_avi_infoframe_pack_only() - write HDMI AVI infoframe to binary buffer
* @frame: HDMI AVI infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Packs the information contained in the @frame structure into a binary
* representation that can be written into the corresponding controller
* registers. Also computes the checksum as required by section 5.3.5 of
* the HDMI 1.4 specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_avi_infoframe_pack_only(const struct hdmi_avi_infoframe *frame,
void *buffer, size_t size)
{
u8 *ptr = buffer;
size_t length;
int ret;
ret = hdmi_avi_infoframe_check_only(frame);
if (ret)
return ret;
length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
if (size < length)
return -ENOSPC;
memset(buffer, 0, size);
ptr[0] = frame->type;
ptr[1] = frame->version;
ptr[2] = frame->length;
ptr[3] = 0; /* checksum */
/* start infoframe payload */
ptr += HDMI_INFOFRAME_HEADER_SIZE;
ptr[0] = ((frame->colorspace & 0x3) << 5) | (frame->scan_mode & 0x3);
/*
* Data byte 1, bit 4 has to be set if we provide the active format
* aspect ratio
*/
if (frame->active_aspect & 0xf)
ptr[0] |= BIT(4);
/* Bit 3 and 2 indicate if we transmit horizontal/vertical bar data */
if (frame->top_bar || frame->bottom_bar)
ptr[0] |= BIT(3);
if (frame->left_bar || frame->right_bar)
ptr[0] |= BIT(2);
ptr[1] = ((frame->colorimetry & 0x3) << 6) |
((frame->picture_aspect & 0x3) << 4) |
(frame->active_aspect & 0xf);
ptr[2] = ((frame->extended_colorimetry & 0x7) << 4) |
((frame->quantization_range & 0x3) << 2) |
(frame->nups & 0x3);
if (frame->itc)
ptr[2] |= BIT(7);
ptr[3] = frame->video_code & 0x7f;
ptr[4] = ((frame->ycc_quantization_range & 0x3) << 6) |
((frame->content_type & 0x3) << 4) |
(frame->pixel_repeat & 0xf);
ptr[5] = frame->top_bar & 0xff;
ptr[6] = (frame->top_bar >> 8) & 0xff;
ptr[7] = frame->bottom_bar & 0xff;
ptr[8] = (frame->bottom_bar >> 8) & 0xff;
ptr[9] = frame->left_bar & 0xff;
ptr[10] = (frame->left_bar >> 8) & 0xff;
ptr[11] = frame->right_bar & 0xff;
ptr[12] = (frame->right_bar >> 8) & 0xff;
hdmi_infoframe_set_checksum(buffer, length);
return length;
}
EXPORT_SYMBOL(hdmi_avi_infoframe_pack_only);
/**
* hdmi_avi_infoframe_pack() - check a HDMI AVI infoframe,
* and write it to binary buffer
* @frame: HDMI AVI infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields, after which it packs the information
* contained in the @frame structure into a binary representation that
* can be written into the corresponding controller registers. This function
* also computes the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_avi_infoframe_pack(struct hdmi_avi_infoframe *frame,
void *buffer, size_t size)
{
int ret;
ret = hdmi_avi_infoframe_check(frame);
if (ret)
return ret;
return hdmi_avi_infoframe_pack_only(frame, buffer, size);
}
EXPORT_SYMBOL(hdmi_avi_infoframe_pack);
/**
* hdmi_spd_infoframe_init() - initialize an HDMI SPD infoframe
* @frame: HDMI SPD infoframe
* @vendor: vendor string
* @product: product string
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_spd_infoframe_init(struct hdmi_spd_infoframe *frame,
const char *vendor, const char *product)
{
memset(frame, 0, sizeof(*frame));
frame->type = HDMI_INFOFRAME_TYPE_SPD;
frame->version = 1;
frame->length = HDMI_SPD_INFOFRAME_SIZE;
strncpy(frame->vendor, vendor, sizeof(frame->vendor));
strncpy(frame->product, product, sizeof(frame->product));
return 0;
}
EXPORT_SYMBOL(hdmi_spd_infoframe_init);
static int hdmi_spd_infoframe_check_only(const struct hdmi_spd_infoframe *frame)
{
if (frame->type != HDMI_INFOFRAME_TYPE_SPD ||
frame->version != 1 ||
frame->length != HDMI_SPD_INFOFRAME_SIZE)
return -EINVAL;
return 0;
}
/**
* hdmi_spd_infoframe_check() - check a HDMI SPD infoframe
* @frame: HDMI SPD infoframe
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields.
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_spd_infoframe_check(struct hdmi_spd_infoframe *frame)
{
return hdmi_spd_infoframe_check_only(frame);
}
EXPORT_SYMBOL(hdmi_spd_infoframe_check);
/**
* hdmi_spd_infoframe_pack_only() - write HDMI SPD infoframe to binary buffer
* @frame: HDMI SPD infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Packs the information contained in the @frame structure into a binary
* representation that can be written into the corresponding controller
* registers. Also computes the checksum as required by section 5.3.5 of
* the HDMI 1.4 specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_spd_infoframe_pack_only(const struct hdmi_spd_infoframe *frame,
void *buffer, size_t size)
{
u8 *ptr = buffer;
size_t length;
int ret;
ret = hdmi_spd_infoframe_check_only(frame);
if (ret)
return ret;
length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
if (size < length)
return -ENOSPC;
memset(buffer, 0, size);
ptr[0] = frame->type;
ptr[1] = frame->version;
ptr[2] = frame->length;
ptr[3] = 0; /* checksum */
/* start infoframe payload */
ptr += HDMI_INFOFRAME_HEADER_SIZE;
memcpy(ptr, frame->vendor, sizeof(frame->vendor));
memcpy(ptr + 8, frame->product, sizeof(frame->product));
ptr[24] = frame->sdi;
hdmi_infoframe_set_checksum(buffer, length);
return length;
}
EXPORT_SYMBOL(hdmi_spd_infoframe_pack_only);
/**
* hdmi_spd_infoframe_pack() - check a HDMI SPD infoframe,
* and write it to binary buffer
* @frame: HDMI SPD infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields, after which it packs the information
* contained in the @frame structure into a binary representation that
* can be written into the corresponding controller registers. This function
* also computes the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_spd_infoframe_pack(struct hdmi_spd_infoframe *frame,
void *buffer, size_t size)
{
int ret;
ret = hdmi_spd_infoframe_check(frame);
if (ret)
return ret;
return hdmi_spd_infoframe_pack_only(frame, buffer, size);
}
EXPORT_SYMBOL(hdmi_spd_infoframe_pack);
/**
* hdmi_audio_infoframe_init() - initialize an HDMI audio infoframe
* @frame: HDMI audio infoframe
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_audio_infoframe_init(struct hdmi_audio_infoframe *frame)
{
memset(frame, 0, sizeof(*frame));
frame->type = HDMI_INFOFRAME_TYPE_AUDIO;
frame->version = 1;
frame->length = HDMI_AUDIO_INFOFRAME_SIZE;
return 0;
}
EXPORT_SYMBOL(hdmi_audio_infoframe_init);
static int hdmi_audio_infoframe_check_only(const struct hdmi_audio_infoframe *frame)
{
if (frame->type != HDMI_INFOFRAME_TYPE_AUDIO ||
frame->version != 1 ||
frame->length != HDMI_AUDIO_INFOFRAME_SIZE)
return -EINVAL;
return 0;
}
/**
* hdmi_audio_infoframe_check() - check a HDMI audio infoframe
* @frame: HDMI audio infoframe
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields.
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_audio_infoframe_check(struct hdmi_audio_infoframe *frame)
{
return hdmi_audio_infoframe_check_only(frame);
}
EXPORT_SYMBOL(hdmi_audio_infoframe_check);
/**
* hdmi_audio_infoframe_pack_only() - write HDMI audio infoframe to binary buffer
* @frame: HDMI audio infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Packs the information contained in the @frame structure into a binary
* representation that can be written into the corresponding controller
* registers. Also computes the checksum as required by section 5.3.5 of
* the HDMI 1.4 specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_audio_infoframe_pack_only(const struct hdmi_audio_infoframe *frame,
void *buffer, size_t size)
{
unsigned char channels;
u8 *ptr = buffer;
size_t length;
int ret;
ret = hdmi_audio_infoframe_check_only(frame);
if (ret)
return ret;
length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
if (size < length)
return -ENOSPC;
memset(buffer, 0, size);
if (frame->channels >= 2)
channels = frame->channels - 1;
else
channels = 0;
ptr[0] = frame->type;
ptr[1] = frame->version;
ptr[2] = frame->length;
ptr[3] = 0; /* checksum */
/* start infoframe payload */
ptr += HDMI_INFOFRAME_HEADER_SIZE;
ptr[0] = ((frame->coding_type & 0xf) << 4) | (channels & 0x7);
ptr[1] = ((frame->sample_frequency & 0x7) << 2) |
(frame->sample_size & 0x3);
ptr[2] = frame->coding_type_ext & 0x1f;
ptr[3] = frame->channel_allocation;
ptr[4] = (frame->level_shift_value & 0xf) << 3;
if (frame->downmix_inhibit)
ptr[4] |= BIT(7);
hdmi_infoframe_set_checksum(buffer, length);
return length;
}
EXPORT_SYMBOL(hdmi_audio_infoframe_pack_only);
/**
* hdmi_audio_infoframe_pack() - check a HDMI Audio infoframe,
* and write it to binary buffer
* @frame: HDMI Audio infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields, after which it packs the information
* contained in the @frame structure into a binary representation that
* can be written into the corresponding controller registers. This function
* also computes the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_audio_infoframe_pack(struct hdmi_audio_infoframe *frame,
void *buffer, size_t size)
{
int ret;
ret = hdmi_audio_infoframe_check(frame);
if (ret)
return ret;
return hdmi_audio_infoframe_pack_only(frame, buffer, size);
}
EXPORT_SYMBOL(hdmi_audio_infoframe_pack);
/**
* hdmi_vendor_infoframe_init() - initialize an HDMI vendor infoframe
* @frame: HDMI vendor infoframe
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_vendor_infoframe_init(struct hdmi_vendor_infoframe *frame)
{
memset(frame, 0, sizeof(*frame));
frame->type = HDMI_INFOFRAME_TYPE_VENDOR;
frame->version = 1;
frame->oui = HDMI_IEEE_OUI;
/*
* 0 is a valid value for s3d_struct, so we use a special "not set"
* value
*/
frame->s3d_struct = HDMI_3D_STRUCTURE_INVALID;
frame->length = 4;
return 0;
}
EXPORT_SYMBOL(hdmi_vendor_infoframe_init);
static int hdmi_vendor_infoframe_length(const struct hdmi_vendor_infoframe *frame)
{
/* for side by side (half) we also need to provide 3D_Ext_Data */
if (frame->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
return 6;
else if (frame->vic != 0 || frame->s3d_struct != HDMI_3D_STRUCTURE_INVALID)
return 5;
else
return 4;
}
static int hdmi_vendor_infoframe_check_only(const struct hdmi_vendor_infoframe *frame)
{
if (frame->type != HDMI_INFOFRAME_TYPE_VENDOR ||
frame->version != 1 ||
frame->oui != HDMI_IEEE_OUI)
return -EINVAL;
/* only one of those can be supplied */
if (frame->vic != 0 && frame->s3d_struct != HDMI_3D_STRUCTURE_INVALID)
return -EINVAL;
if (frame->length != hdmi_vendor_infoframe_length(frame))
return -EINVAL;
return 0;
}
/**
* hdmi_vendor_infoframe_check() - check a HDMI vendor infoframe
* @frame: HDMI infoframe
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields.
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_vendor_infoframe_check(struct hdmi_vendor_infoframe *frame)
{
frame->length = hdmi_vendor_infoframe_length(frame);
return hdmi_vendor_infoframe_check_only(frame);
}
EXPORT_SYMBOL(hdmi_vendor_infoframe_check);
/**
* hdmi_vendor_infoframe_pack_only() - write a HDMI vendor infoframe to binary buffer
* @frame: HDMI infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Packs the information contained in the @frame structure into a binary
* representation that can be written into the corresponding controller
* registers. Also computes the checksum as required by section 5.3.5 of
* the HDMI 1.4 specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_vendor_infoframe_pack_only(const struct hdmi_vendor_infoframe *frame,
void *buffer, size_t size)
{
u8 *ptr = buffer;
size_t length;
int ret;
ret = hdmi_vendor_infoframe_check_only(frame);
if (ret)
return ret;
length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
if (size < length)
return -ENOSPC;
memset(buffer, 0, size);
ptr[0] = frame->type;
ptr[1] = frame->version;
ptr[2] = frame->length;
ptr[3] = 0; /* checksum */
/* HDMI OUI */
ptr[4] = 0x03;
ptr[5] = 0x0c;
ptr[6] = 0x00;
if (frame->s3d_struct != HDMI_3D_STRUCTURE_INVALID) {
ptr[7] = 0x2 << 5; /* video format */
ptr[8] = (frame->s3d_struct & 0xf) << 4;
if (frame->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
ptr[9] = (frame->s3d_ext_data & 0xf) << 4;
} else if (frame->vic) {
ptr[7] = 0x1 << 5; /* video format */
ptr[8] = frame->vic;
} else {
ptr[7] = 0x0 << 5; /* video format */
}
hdmi_infoframe_set_checksum(buffer, length);
return length;
}
EXPORT_SYMBOL(hdmi_vendor_infoframe_pack_only);
/**
* hdmi_vendor_infoframe_pack() - check a HDMI Vendor infoframe,
* and write it to binary buffer
* @frame: HDMI Vendor infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields, after which it packs the information
* contained in the @frame structure into a binary representation that
* can be written into the corresponding controller registers. This function
* also computes the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_vendor_infoframe_pack(struct hdmi_vendor_infoframe *frame,
void *buffer, size_t size)
{
int ret;
ret = hdmi_vendor_infoframe_check(frame);
if (ret)
return ret;
return hdmi_vendor_infoframe_pack_only(frame, buffer, size);
}
EXPORT_SYMBOL(hdmi_vendor_infoframe_pack);
static int
hdmi_vendor_any_infoframe_check_only(const union hdmi_vendor_any_infoframe *frame)
{
if (frame->any.type != HDMI_INFOFRAME_TYPE_VENDOR ||
frame->any.version != 1)
return -EINVAL;
return 0;
}
/**
* hdmi_drm_infoframe_init() - initialize an HDMI Dynaminc Range and
* mastering infoframe
* @frame: HDMI DRM infoframe
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_drm_infoframe_init(struct hdmi_drm_infoframe *frame)
{
memset(frame, 0, sizeof(*frame));
frame->type = HDMI_INFOFRAME_TYPE_DRM;
frame->version = 1;
frame->length = HDMI_DRM_INFOFRAME_SIZE;
return 0;
}
EXPORT_SYMBOL(hdmi_drm_infoframe_init);
static int hdmi_drm_infoframe_check_only(const struct hdmi_drm_infoframe *frame)
{
if (frame->type != HDMI_INFOFRAME_TYPE_DRM ||
frame->version != 1)
return -EINVAL;
if (frame->length != HDMI_DRM_INFOFRAME_SIZE)
return -EINVAL;
return 0;
}
/**
* hdmi_drm_infoframe_check() - check a HDMI DRM infoframe
* @frame: HDMI DRM infoframe
*
* Validates that the infoframe is consistent.
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_drm_infoframe_check(struct hdmi_drm_infoframe *frame)
{
return hdmi_drm_infoframe_check_only(frame);
}
EXPORT_SYMBOL(hdmi_drm_infoframe_check);
/**
* hdmi_drm_infoframe_pack_only() - write HDMI DRM infoframe to binary buffer
* @frame: HDMI DRM infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Packs the information contained in the @frame structure into a binary
* representation that can be written into the corresponding controller
* registers. Also computes the checksum as required by section 5.3.5 of
* the HDMI 1.4 specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_drm_infoframe_pack_only(const struct hdmi_drm_infoframe *frame,
void *buffer, size_t size)
{
u8 *ptr = buffer;
size_t length;
int i;
length = HDMI_INFOFRAME_HEADER_SIZE + frame->length;
if (size < length)
return -ENOSPC;
memset(buffer, 0, size);
ptr[0] = frame->type;
ptr[1] = frame->version;
ptr[2] = frame->length;
ptr[3] = 0; /* checksum */
/* start infoframe payload */
ptr += HDMI_INFOFRAME_HEADER_SIZE;
*ptr++ = frame->eotf;
*ptr++ = frame->metadata_type;
for (i = 0; i < 3; i++) {
*ptr++ = frame->display_primaries[i].x;
*ptr++ = frame->display_primaries[i].x >> 8;
*ptr++ = frame->display_primaries[i].y;
*ptr++ = frame->display_primaries[i].y >> 8;
}
*ptr++ = frame->white_point.x;
*ptr++ = frame->white_point.x >> 8;
*ptr++ = frame->white_point.y;
*ptr++ = frame->white_point.y >> 8;
*ptr++ = frame->max_display_mastering_luminance;
*ptr++ = frame->max_display_mastering_luminance >> 8;
*ptr++ = frame->min_display_mastering_luminance;
*ptr++ = frame->min_display_mastering_luminance >> 8;
*ptr++ = frame->max_cll;
*ptr++ = frame->max_cll >> 8;
*ptr++ = frame->max_fall;
*ptr++ = frame->max_fall >> 8;
hdmi_infoframe_set_checksum(buffer, length);
return length;
}
EXPORT_SYMBOL(hdmi_drm_infoframe_pack_only);
/**
* hdmi_drm_infoframe_pack() - check a HDMI DRM infoframe,
* and write it to binary buffer
* @frame: HDMI DRM infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields, after which it packs the information
* contained in the @frame structure into a binary representation that
* can be written into the corresponding controller registers. This function
* also computes the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t hdmi_drm_infoframe_pack(struct hdmi_drm_infoframe *frame,
void *buffer, size_t size)
{
int ret;
ret = hdmi_drm_infoframe_check(frame);
if (ret)
return ret;
return hdmi_drm_infoframe_pack_only(frame, buffer, size);
}
EXPORT_SYMBOL(hdmi_drm_infoframe_pack);
/*
* hdmi_vendor_any_infoframe_check() - check a vendor infoframe
*/
static int
hdmi_vendor_any_infoframe_check(union hdmi_vendor_any_infoframe *frame)
{
int ret;
ret = hdmi_vendor_any_infoframe_check_only(frame);
if (ret)
return ret;
/* we only know about HDMI vendor infoframes */
if (frame->any.oui != HDMI_IEEE_OUI)
return -EINVAL;
return hdmi_vendor_infoframe_check(&frame->hdmi);
}
/*
* hdmi_vendor_any_infoframe_pack_only() - write a vendor infoframe to binary buffer
*/
static ssize_t
hdmi_vendor_any_infoframe_pack_only(const union hdmi_vendor_any_infoframe *frame,
void *buffer, size_t size)
{
int ret;
ret = hdmi_vendor_any_infoframe_check_only(frame);
if (ret)
return ret;
/* we only know about HDMI vendor infoframes */
if (frame->any.oui != HDMI_IEEE_OUI)
return -EINVAL;
return hdmi_vendor_infoframe_pack_only(&frame->hdmi, buffer, size);
}
/*
* hdmi_vendor_any_infoframe_pack() - check a vendor infoframe,
* and write it to binary buffer
*/
static ssize_t
hdmi_vendor_any_infoframe_pack(union hdmi_vendor_any_infoframe *frame,
void *buffer, size_t size)
{
int ret;
ret = hdmi_vendor_any_infoframe_check(frame);
if (ret)
return ret;
return hdmi_vendor_any_infoframe_pack_only(frame, buffer, size);
}
/**
* hdmi_infoframe_check() - check a HDMI infoframe
* @frame: HDMI infoframe
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields.
*
* Returns 0 on success or a negative error code on failure.
*/
int
hdmi_infoframe_check(union hdmi_infoframe *frame)
{
switch (frame->any.type) {
case HDMI_INFOFRAME_TYPE_AVI:
return hdmi_avi_infoframe_check(&frame->avi);
case HDMI_INFOFRAME_TYPE_SPD:
return hdmi_spd_infoframe_check(&frame->spd);
case HDMI_INFOFRAME_TYPE_AUDIO:
return hdmi_audio_infoframe_check(&frame->audio);
case HDMI_INFOFRAME_TYPE_VENDOR:
return hdmi_vendor_any_infoframe_check(&frame->vendor);
default:
WARN(1, "Bad infoframe type %d\n", frame->any.type);
return -EINVAL;
}
}
EXPORT_SYMBOL(hdmi_infoframe_check);
/**
* hdmi_infoframe_pack_only() - write a HDMI infoframe to binary buffer
* @frame: HDMI infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Packs the information contained in the @frame structure into a binary
* representation that can be written into the corresponding controller
* registers. Also computes the checksum as required by section 5.3.5 of
* the HDMI 1.4 specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t
hdmi_infoframe_pack_only(const union hdmi_infoframe *frame, void *buffer, size_t size)
{
ssize_t length;
switch (frame->any.type) {
case HDMI_INFOFRAME_TYPE_AVI:
length = hdmi_avi_infoframe_pack_only(&frame->avi,
buffer, size);
break;
case HDMI_INFOFRAME_TYPE_DRM:
length = hdmi_drm_infoframe_pack_only(&frame->drm,
buffer, size);
break;
case HDMI_INFOFRAME_TYPE_SPD:
length = hdmi_spd_infoframe_pack_only(&frame->spd,
buffer, size);
break;
case HDMI_INFOFRAME_TYPE_AUDIO:
length = hdmi_audio_infoframe_pack_only(&frame->audio,
buffer, size);
break;
case HDMI_INFOFRAME_TYPE_VENDOR:
length = hdmi_vendor_any_infoframe_pack_only(&frame->vendor,
buffer, size);
break;
default:
WARN(1, "Bad infoframe type %d\n", frame->any.type);
length = -EINVAL;
}
return length;
}
EXPORT_SYMBOL(hdmi_infoframe_pack_only);
/**
* hdmi_infoframe_pack() - check a HDMI infoframe,
* and write it to binary buffer
* @frame: HDMI infoframe
* @buffer: destination buffer
* @size: size of buffer
*
* Validates that the infoframe is consistent and updates derived fields
* (eg. length) based on other fields, after which it packs the information
* contained in the @frame structure into a binary representation that
* can be written into the corresponding controller registers. This function
* also computes the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns the number of bytes packed into the binary buffer or a negative
* error code on failure.
*/
ssize_t
hdmi_infoframe_pack(union hdmi_infoframe *frame,
void *buffer, size_t size)
{
ssize_t length;
switch (frame->any.type) {
case HDMI_INFOFRAME_TYPE_AVI:
length = hdmi_avi_infoframe_pack(&frame->avi, buffer, size);
break;
case HDMI_INFOFRAME_TYPE_DRM:
length = hdmi_drm_infoframe_pack(&frame->drm, buffer, size);
break;
case HDMI_INFOFRAME_TYPE_SPD:
length = hdmi_spd_infoframe_pack(&frame->spd, buffer, size);
break;
case HDMI_INFOFRAME_TYPE_AUDIO:
length = hdmi_audio_infoframe_pack(&frame->audio, buffer, size);
break;
case HDMI_INFOFRAME_TYPE_VENDOR:
length = hdmi_vendor_any_infoframe_pack(&frame->vendor,
buffer, size);
break;
default:
WARN(1, "Bad infoframe type %d\n", frame->any.type);
length = -EINVAL;
}
return length;
}
EXPORT_SYMBOL(hdmi_infoframe_pack);
static const char *hdmi_infoframe_type_get_name(enum hdmi_infoframe_type type)
{
if (type < 0x80 || type > 0x9f)
return "Invalid";
switch (type) {
case HDMI_INFOFRAME_TYPE_VENDOR:
return "Vendor";
case HDMI_INFOFRAME_TYPE_AVI:
return "Auxiliary Video Information (AVI)";
case HDMI_INFOFRAME_TYPE_SPD:
return "Source Product Description (SPD)";
case HDMI_INFOFRAME_TYPE_AUDIO:
return "Audio";
case HDMI_INFOFRAME_TYPE_DRM:
return "Dynamic Range and Mastering";
}
return "Reserved";
}
static void hdmi_infoframe_log_header(const char *level,
struct device *dev,
const struct hdmi_any_infoframe *frame)
{
hdmi_log("HDMI infoframe: %s, version %u, length %u\n",
hdmi_infoframe_type_get_name(frame->type),
frame->version, frame->length);
}
static const char *hdmi_colorspace_get_name(enum hdmi_colorspace colorspace)
{
switch (colorspace) {
case HDMI_COLORSPACE_RGB:
return "RGB";
case HDMI_COLORSPACE_YUV422:
return "YCbCr 4:2:2";
case HDMI_COLORSPACE_YUV444:
return "YCbCr 4:4:4";
case HDMI_COLORSPACE_YUV420:
return "YCbCr 4:2:0";
case HDMI_COLORSPACE_RESERVED4:
return "Reserved (4)";
case HDMI_COLORSPACE_RESERVED5:
return "Reserved (5)";
case HDMI_COLORSPACE_RESERVED6:
return "Reserved (6)";
case HDMI_COLORSPACE_IDO_DEFINED:
return "IDO Defined";
}
return "Invalid";
}
static const char *hdmi_scan_mode_get_name(enum hdmi_scan_mode scan_mode)
{
switch (scan_mode) {
case HDMI_SCAN_MODE_NONE:
return "No Data";
case HDMI_SCAN_MODE_OVERSCAN:
return "Overscan";
case HDMI_SCAN_MODE_UNDERSCAN:
return "Underscan";
case HDMI_SCAN_MODE_RESERVED:
return "Reserved";
}
return "Invalid";
}
static const char *hdmi_colorimetry_get_name(enum hdmi_colorimetry colorimetry)
{
switch (colorimetry) {
case HDMI_COLORIMETRY_NONE:
return "No Data";
case HDMI_COLORIMETRY_ITU_601:
return "ITU601";
case HDMI_COLORIMETRY_ITU_709:
return "ITU709";
case HDMI_COLORIMETRY_EXTENDED:
return "Extended";
}
return "Invalid";
}
static const char *
hdmi_picture_aspect_get_name(enum hdmi_picture_aspect picture_aspect)
{
switch (picture_aspect) {
case HDMI_PICTURE_ASPECT_NONE:
return "No Data";
case HDMI_PICTURE_ASPECT_4_3:
return "4:3";
case HDMI_PICTURE_ASPECT_16_9:
return "16:9";
case HDMI_PICTURE_ASPECT_64_27:
return "64:27";
case HDMI_PICTURE_ASPECT_256_135:
return "256:135";
case HDMI_PICTURE_ASPECT_RESERVED:
return "Reserved";
}
return "Invalid";
}
static const char *
hdmi_active_aspect_get_name(enum hdmi_active_aspect active_aspect)
{
if (active_aspect < 0 || active_aspect > 0xf)
return "Invalid";
switch (active_aspect) {
case HDMI_ACTIVE_ASPECT_16_9_TOP:
return "16:9 Top";
case HDMI_ACTIVE_ASPECT_14_9_TOP:
return "14:9 Top";
case HDMI_ACTIVE_ASPECT_16_9_CENTER:
return "16:9 Center";
case HDMI_ACTIVE_ASPECT_PICTURE:
return "Same as Picture";
case HDMI_ACTIVE_ASPECT_4_3:
return "4:3";
case HDMI_ACTIVE_ASPECT_16_9:
return "16:9";
case HDMI_ACTIVE_ASPECT_14_9:
return "14:9";
case HDMI_ACTIVE_ASPECT_4_3_SP_14_9:
return "4:3 SP 14:9";
case HDMI_ACTIVE_ASPECT_16_9_SP_14_9:
return "16:9 SP 14:9";
case HDMI_ACTIVE_ASPECT_16_9_SP_4_3:
return "16:9 SP 4:3";
}
return "Reserved";
}
static const char *
hdmi_extended_colorimetry_get_name(enum hdmi_extended_colorimetry ext_col)
{
switch (ext_col) {
case HDMI_EXTENDED_COLORIMETRY_XV_YCC_601:
return "xvYCC 601";
case HDMI_EXTENDED_COLORIMETRY_XV_YCC_709:
return "xvYCC 709";
case HDMI_EXTENDED_COLORIMETRY_S_YCC_601:
return "sYCC 601";
case HDMI_EXTENDED_COLORIMETRY_OPYCC_601:
return "opYCC 601";
case HDMI_EXTENDED_COLORIMETRY_OPRGB:
return "opRGB";
case HDMI_EXTENDED_COLORIMETRY_BT2020_CONST_LUM:
return "BT.2020 Constant Luminance";
case HDMI_EXTENDED_COLORIMETRY_BT2020:
return "BT.2020";
case HDMI_EXTENDED_COLORIMETRY_RESERVED:
return "Reserved";
}
return "Invalid";
}
static const char *
hdmi_quantization_range_get_name(enum hdmi_quantization_range qrange)
{
switch (qrange) {
case HDMI_QUANTIZATION_RANGE_DEFAULT:
return "Default";
case HDMI_QUANTIZATION_RANGE_LIMITED:
return "Limited";
case HDMI_QUANTIZATION_RANGE_FULL:
return "Full";
case HDMI_QUANTIZATION_RANGE_RESERVED:
return "Reserved";
}
return "Invalid";
}
static const char *hdmi_nups_get_name(enum hdmi_nups nups)
{
switch (nups) {
case HDMI_NUPS_UNKNOWN:
return "Unknown Non-uniform Scaling";
case HDMI_NUPS_HORIZONTAL:
return "Horizontally Scaled";
case HDMI_NUPS_VERTICAL:
return "Vertically Scaled";
case HDMI_NUPS_BOTH:
return "Horizontally and Vertically Scaled";
}
return "Invalid";
}
static const char *
hdmi_ycc_quantization_range_get_name(enum hdmi_ycc_quantization_range qrange)
{
switch (qrange) {
case HDMI_YCC_QUANTIZATION_RANGE_LIMITED:
return "Limited";
case HDMI_YCC_QUANTIZATION_RANGE_FULL:
return "Full";
}
return "Invalid";
}
static const char *
hdmi_content_type_get_name(enum hdmi_content_type content_type)
{
switch (content_type) {
case HDMI_CONTENT_TYPE_GRAPHICS:
return "Graphics";
case HDMI_CONTENT_TYPE_PHOTO:
return "Photo";
case HDMI_CONTENT_TYPE_CINEMA:
return "Cinema";
case HDMI_CONTENT_TYPE_GAME:
return "Game";
}
return "Invalid";
}
static void hdmi_avi_infoframe_log(const char *level,
struct device *dev,
const struct hdmi_avi_infoframe *frame)
{
hdmi_infoframe_log_header(level, dev,
(const struct hdmi_any_infoframe *)frame);
hdmi_log(" colorspace: %s\n",
hdmi_colorspace_get_name(frame->colorspace));
hdmi_log(" scan mode: %s\n",
hdmi_scan_mode_get_name(frame->scan_mode));
hdmi_log(" colorimetry: %s\n",
hdmi_colorimetry_get_name(frame->colorimetry));
hdmi_log(" picture aspect: %s\n",
hdmi_picture_aspect_get_name(frame->picture_aspect));
hdmi_log(" active aspect: %s\n",
hdmi_active_aspect_get_name(frame->active_aspect));
hdmi_log(" itc: %s\n", frame->itc ? "IT Content" : "No Data");
hdmi_log(" extended colorimetry: %s\n",
hdmi_extended_colorimetry_get_name(frame->extended_colorimetry));
hdmi_log(" quantization range: %s\n",
hdmi_quantization_range_get_name(frame->quantization_range));
hdmi_log(" nups: %s\n", hdmi_nups_get_name(frame->nups));
hdmi_log(" video code: %u\n", frame->video_code);
hdmi_log(" ycc quantization range: %s\n",
hdmi_ycc_quantization_range_get_name(frame->ycc_quantization_range));
hdmi_log(" hdmi content type: %s\n",
hdmi_content_type_get_name(frame->content_type));
hdmi_log(" pixel repeat: %u\n", frame->pixel_repeat);
hdmi_log(" bar top %u, bottom %u, left %u, right %u\n",
frame->top_bar, frame->bottom_bar,
frame->left_bar, frame->right_bar);
}
static const char *hdmi_spd_sdi_get_name(enum hdmi_spd_sdi sdi)
{
if (sdi < 0 || sdi > 0xff)
return "Invalid";
switch (sdi) {
case HDMI_SPD_SDI_UNKNOWN:
return "Unknown";
case HDMI_SPD_SDI_DSTB:
return "Digital STB";
case HDMI_SPD_SDI_DVDP:
return "DVD Player";
case HDMI_SPD_SDI_DVHS:
return "D-VHS";
case HDMI_SPD_SDI_HDDVR:
return "HDD Videorecorder";
case HDMI_SPD_SDI_DVC:
return "DVC";
case HDMI_SPD_SDI_DSC:
return "DSC";
case HDMI_SPD_SDI_VCD:
return "Video CD";
case HDMI_SPD_SDI_GAME:
return "Game";
case HDMI_SPD_SDI_PC:
return "PC General";
case HDMI_SPD_SDI_BD:
return "Blu-Ray Disc (BD)";
case HDMI_SPD_SDI_SACD:
return "Super Audio CD";
case HDMI_SPD_SDI_HDDVD:
return "HD DVD";
case HDMI_SPD_SDI_PMP:
return "PMP";
}
return "Reserved";
}
static void hdmi_spd_infoframe_log(const char *level,
struct device *dev,
const struct hdmi_spd_infoframe *frame)
{
u8 buf[17];
hdmi_infoframe_log_header(level, dev,
(const struct hdmi_any_infoframe *)frame);
memset(buf, 0, sizeof(buf));
strncpy(buf, frame->vendor, 8);
hdmi_log(" vendor: %s\n", buf);
strncpy(buf, frame->product, 16);
hdmi_log(" product: %s\n", buf);
hdmi_log(" source device information: %s (0x%x)\n",
hdmi_spd_sdi_get_name(frame->sdi), frame->sdi);
}
static const char *
hdmi_audio_coding_type_get_name(enum hdmi_audio_coding_type coding_type)
{
switch (coding_type) {
case HDMI_AUDIO_CODING_TYPE_STREAM:
return "Refer to Stream Header";
case HDMI_AUDIO_CODING_TYPE_PCM:
return "PCM";
case HDMI_AUDIO_CODING_TYPE_AC3:
return "AC-3";
case HDMI_AUDIO_CODING_TYPE_MPEG1:
return "MPEG1";
case HDMI_AUDIO_CODING_TYPE_MP3:
return "MP3";
case HDMI_AUDIO_CODING_TYPE_MPEG2:
return "MPEG2";
case HDMI_AUDIO_CODING_TYPE_AAC_LC:
return "AAC";
case HDMI_AUDIO_CODING_TYPE_DTS:
return "DTS";
case HDMI_AUDIO_CODING_TYPE_ATRAC:
return "ATRAC";
case HDMI_AUDIO_CODING_TYPE_DSD:
return "One Bit Audio";
case HDMI_AUDIO_CODING_TYPE_EAC3:
return "Dolby Digital +";
case HDMI_AUDIO_CODING_TYPE_DTS_HD:
return "DTS-HD";
case HDMI_AUDIO_CODING_TYPE_MLP:
return "MAT (MLP)";
case HDMI_AUDIO_CODING_TYPE_DST:
return "DST";
case HDMI_AUDIO_CODING_TYPE_WMA_PRO:
return "WMA PRO";
case HDMI_AUDIO_CODING_TYPE_CXT:
return "Refer to CXT";
}
return "Invalid";
}
static const char *
hdmi_audio_sample_size_get_name(enum hdmi_audio_sample_size sample_size)
{
switch (sample_size) {
case HDMI_AUDIO_SAMPLE_SIZE_STREAM:
return "Refer to Stream Header";
case HDMI_AUDIO_SAMPLE_SIZE_16:
return "16 bit";
case HDMI_AUDIO_SAMPLE_SIZE_20:
return "20 bit";
case HDMI_AUDIO_SAMPLE_SIZE_24:
return "24 bit";
}
return "Invalid";
}
static const char *
hdmi_audio_sample_frequency_get_name(enum hdmi_audio_sample_frequency freq)
{
switch (freq) {
case HDMI_AUDIO_SAMPLE_FREQUENCY_STREAM:
return "Refer to Stream Header";
case HDMI_AUDIO_SAMPLE_FREQUENCY_32000:
return "32 kHz";
case HDMI_AUDIO_SAMPLE_FREQUENCY_44100:
return "44.1 kHz (CD)";
case HDMI_AUDIO_SAMPLE_FREQUENCY_48000:
return "48 kHz";
case HDMI_AUDIO_SAMPLE_FREQUENCY_88200:
return "88.2 kHz";
case HDMI_AUDIO_SAMPLE_FREQUENCY_96000:
return "96 kHz";
case HDMI_AUDIO_SAMPLE_FREQUENCY_176400:
return "176.4 kHz";
case HDMI_AUDIO_SAMPLE_FREQUENCY_192000:
return "192 kHz";
}
return "Invalid";
}
static const char *
hdmi_audio_coding_type_ext_get_name(enum hdmi_audio_coding_type_ext ctx)
{
if (ctx < 0 || ctx > 0x1f)
return "Invalid";
switch (ctx) {
case HDMI_AUDIO_CODING_TYPE_EXT_CT:
return "Refer to CT";
case HDMI_AUDIO_CODING_TYPE_EXT_HE_AAC:
return "HE AAC";
case HDMI_AUDIO_CODING_TYPE_EXT_HE_AAC_V2:
return "HE AAC v2";
case HDMI_AUDIO_CODING_TYPE_EXT_MPEG_SURROUND:
return "MPEG SURROUND";
case HDMI_AUDIO_CODING_TYPE_EXT_MPEG4_HE_AAC:
return "MPEG-4 HE AAC";
case HDMI_AUDIO_CODING_TYPE_EXT_MPEG4_HE_AAC_V2:
return "MPEG-4 HE AAC v2";
case HDMI_AUDIO_CODING_TYPE_EXT_MPEG4_AAC_LC:
return "MPEG-4 AAC LC";
case HDMI_AUDIO_CODING_TYPE_EXT_DRA:
return "DRA";
case HDMI_AUDIO_CODING_TYPE_EXT_MPEG4_HE_AAC_SURROUND:
return "MPEG-4 HE AAC + MPEG Surround";
case HDMI_AUDIO_CODING_TYPE_EXT_MPEG4_AAC_LC_SURROUND:
return "MPEG-4 AAC LC + MPEG Surround";
}
return "Reserved";
}
static void hdmi_audio_infoframe_log(const char *level,
struct device *dev,
const struct hdmi_audio_infoframe *frame)
{
hdmi_infoframe_log_header(level, dev,
(const struct hdmi_any_infoframe *)frame);
if (frame->channels)
hdmi_log(" channels: %u\n", frame->channels - 1);
else
hdmi_log(" channels: Refer to stream header\n");
hdmi_log(" coding type: %s\n",
hdmi_audio_coding_type_get_name(frame->coding_type));
hdmi_log(" sample size: %s\n",
hdmi_audio_sample_size_get_name(frame->sample_size));
hdmi_log(" sample frequency: %s\n",
hdmi_audio_sample_frequency_get_name(frame->sample_frequency));
hdmi_log(" coding type ext: %s\n",
hdmi_audio_coding_type_ext_get_name(frame->coding_type_ext));
hdmi_log(" channel allocation: 0x%x\n",
frame->channel_allocation);
hdmi_log(" level shift value: %u dB\n",
frame->level_shift_value);
hdmi_log(" downmix inhibit: %s\n",
frame->downmix_inhibit ? "Yes" : "No");
}
static void hdmi_drm_infoframe_log(const char *level,
struct device *dev,
const struct hdmi_drm_infoframe *frame)
{
int i;
hdmi_infoframe_log_header(level, dev,
(struct hdmi_any_infoframe *)frame);
hdmi_log("length: %d\n", frame->length);
hdmi_log("metadata type: %d\n", frame->metadata_type);
hdmi_log("eotf: %d\n", frame->eotf);
for (i = 0; i < 3; i++) {
hdmi_log("x[%d]: %d\n", i, frame->display_primaries[i].x);
hdmi_log("y[%d]: %d\n", i, frame->display_primaries[i].y);
}
hdmi_log("white point x: %d\n", frame->white_point.x);
hdmi_log("white point y: %d\n", frame->white_point.y);
hdmi_log("max_display_mastering_luminance: %d\n",
frame->max_display_mastering_luminance);
hdmi_log("min_display_mastering_luminance: %d\n",
frame->min_display_mastering_luminance);
hdmi_log("max_cll: %d\n", frame->max_cll);
hdmi_log("max_fall: %d\n", frame->max_fall);
}
static const char *
hdmi_3d_structure_get_name(enum hdmi_3d_structure s3d_struct)
{
if (s3d_struct < 0 || s3d_struct > 0xf)
return "Invalid";
switch (s3d_struct) {
case HDMI_3D_STRUCTURE_FRAME_PACKING:
return "Frame Packing";
case HDMI_3D_STRUCTURE_FIELD_ALTERNATIVE:
return "Field Alternative";
case HDMI_3D_STRUCTURE_LINE_ALTERNATIVE:
return "Line Alternative";
case HDMI_3D_STRUCTURE_SIDE_BY_SIDE_FULL:
return "Side-by-side (Full)";
case HDMI_3D_STRUCTURE_L_DEPTH:
return "L + Depth";
case HDMI_3D_STRUCTURE_L_DEPTH_GFX_GFX_DEPTH:
return "L + Depth + Graphics + Graphics-depth";
case HDMI_3D_STRUCTURE_TOP_AND_BOTTOM:
return "Top-and-Bottom";
case HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF:
return "Side-by-side (Half)";
default:
break;
}
return "Reserved";
}
static void
hdmi_vendor_any_infoframe_log(const char *level,
struct device *dev,
const union hdmi_vendor_any_infoframe *frame)
{
const struct hdmi_vendor_infoframe *hvf = &frame->hdmi;
hdmi_infoframe_log_header(level, dev,
(const struct hdmi_any_infoframe *)frame);
if (frame->any.oui != HDMI_IEEE_OUI) {
hdmi_log(" not a HDMI vendor infoframe\n");
return;
}
if (hvf->vic == 0 && hvf->s3d_struct == HDMI_3D_STRUCTURE_INVALID) {
hdmi_log(" empty frame\n");
return;
}
if (hvf->vic)
hdmi_log(" HDMI VIC: %u\n", hvf->vic);
if (hvf->s3d_struct != HDMI_3D_STRUCTURE_INVALID) {
hdmi_log(" 3D structure: %s\n",
hdmi_3d_structure_get_name(hvf->s3d_struct));
if (hvf->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF)
hdmi_log(" 3D extension data: %d\n",
hvf->s3d_ext_data);
}
}
/**
* hdmi_infoframe_log() - log info of HDMI infoframe
* @level: logging level
* @dev: device
* @frame: HDMI infoframe
*/
void hdmi_infoframe_log(const char *level,
struct device *dev,
const union hdmi_infoframe *frame)
{
switch (frame->any.type) {
case HDMI_INFOFRAME_TYPE_AVI:
hdmi_avi_infoframe_log(level, dev, &frame->avi);
break;
case HDMI_INFOFRAME_TYPE_SPD:
hdmi_spd_infoframe_log(level, dev, &frame->spd);
break;
case HDMI_INFOFRAME_TYPE_AUDIO:
hdmi_audio_infoframe_log(level, dev, &frame->audio);
break;
case HDMI_INFOFRAME_TYPE_VENDOR:
hdmi_vendor_any_infoframe_log(level, dev, &frame->vendor);
break;
case HDMI_INFOFRAME_TYPE_DRM:
hdmi_drm_infoframe_log(level, dev, &frame->drm);
break;
}
}
EXPORT_SYMBOL(hdmi_infoframe_log);
/**
* hdmi_avi_infoframe_unpack() - unpack binary buffer to a HDMI AVI infoframe
* @frame: HDMI AVI infoframe
* @buffer: source buffer
* @size: size of buffer
*
* Unpacks the information contained in binary @buffer into a structured
* @frame of the HDMI Auxiliary Video (AVI) information frame.
* Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns 0 on success or a negative error code on failure.
*/
static int hdmi_avi_infoframe_unpack(struct hdmi_avi_infoframe *frame,
const void *buffer, size_t size)
{
const u8 *ptr = buffer;
if (size < HDMI_INFOFRAME_SIZE(AVI))
return -EINVAL;
if (ptr[0] != HDMI_INFOFRAME_TYPE_AVI ||
ptr[1] != 2 ||
ptr[2] != HDMI_AVI_INFOFRAME_SIZE)
return -EINVAL;
if (hdmi_infoframe_checksum(buffer, HDMI_INFOFRAME_SIZE(AVI)) != 0)
return -EINVAL;
hdmi_avi_infoframe_init(frame);
ptr += HDMI_INFOFRAME_HEADER_SIZE;
frame->colorspace = (ptr[0] >> 5) & 0x3;
if (ptr[0] & 0x10)
frame->active_aspect = ptr[1] & 0xf;
if (ptr[0] & 0x8) {
frame->top_bar = (ptr[6] << 8) | ptr[5];
frame->bottom_bar = (ptr[8] << 8) | ptr[7];
}
if (ptr[0] & 0x4) {
frame->left_bar = (ptr[10] << 8) | ptr[9];
frame->right_bar = (ptr[12] << 8) | ptr[11];
}
frame->scan_mode = ptr[0] & 0x3;
frame->colorimetry = (ptr[1] >> 6) & 0x3;
frame->picture_aspect = (ptr[1] >> 4) & 0x3;
frame->active_aspect = ptr[1] & 0xf;
frame->itc = ptr[2] & 0x80 ? true : false;
frame->extended_colorimetry = (ptr[2] >> 4) & 0x7;
frame->quantization_range = (ptr[2] >> 2) & 0x3;
frame->nups = ptr[2] & 0x3;
frame->video_code = ptr[3] & 0x7f;
frame->ycc_quantization_range = (ptr[4] >> 6) & 0x3;
frame->content_type = (ptr[4] >> 4) & 0x3;
frame->pixel_repeat = ptr[4] & 0xf;
return 0;
}
/**
* hdmi_spd_infoframe_unpack() - unpack binary buffer to a HDMI SPD infoframe
* @frame: HDMI SPD infoframe
* @buffer: source buffer
* @size: size of buffer
*
* Unpacks the information contained in binary @buffer into a structured
* @frame of the HDMI Source Product Description (SPD) information frame.
* Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns 0 on success or a negative error code on failure.
*/
static int hdmi_spd_infoframe_unpack(struct hdmi_spd_infoframe *frame,
const void *buffer, size_t size)
{
const u8 *ptr = buffer;
int ret;
if (size < HDMI_INFOFRAME_SIZE(SPD))
return -EINVAL;
if (ptr[0] != HDMI_INFOFRAME_TYPE_SPD ||
ptr[1] != 1 ||
ptr[2] != HDMI_SPD_INFOFRAME_SIZE) {
return -EINVAL;
}
if (hdmi_infoframe_checksum(buffer, HDMI_INFOFRAME_SIZE(SPD)) != 0)
return -EINVAL;
ptr += HDMI_INFOFRAME_HEADER_SIZE;
ret = hdmi_spd_infoframe_init(frame, ptr, ptr + 8);
if (ret)
return ret;
frame->sdi = ptr[24];
return 0;
}
/**
* hdmi_audio_infoframe_unpack() - unpack binary buffer to a HDMI AUDIO infoframe
* @frame: HDMI Audio infoframe
* @buffer: source buffer
* @size: size of buffer
*
* Unpacks the information contained in binary @buffer into a structured
* @frame of the HDMI Audio information frame.
* Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns 0 on success or a negative error code on failure.
*/
static int hdmi_audio_infoframe_unpack(struct hdmi_audio_infoframe *frame,
const void *buffer, size_t size)
{
const u8 *ptr = buffer;
int ret;
if (size < HDMI_INFOFRAME_SIZE(AUDIO))
return -EINVAL;
if (ptr[0] != HDMI_INFOFRAME_TYPE_AUDIO ||
ptr[1] != 1 ||
ptr[2] != HDMI_AUDIO_INFOFRAME_SIZE) {
return -EINVAL;
}
if (hdmi_infoframe_checksum(buffer, HDMI_INFOFRAME_SIZE(AUDIO)) != 0)
return -EINVAL;
ret = hdmi_audio_infoframe_init(frame);
if (ret)
return ret;
ptr += HDMI_INFOFRAME_HEADER_SIZE;
frame->channels = ptr[0] & 0x7;
frame->coding_type = (ptr[0] >> 4) & 0xf;
frame->sample_size = ptr[1] & 0x3;
frame->sample_frequency = (ptr[1] >> 2) & 0x7;
frame->coding_type_ext = ptr[2] & 0x1f;
frame->channel_allocation = ptr[3];
frame->level_shift_value = (ptr[4] >> 3) & 0xf;
frame->downmix_inhibit = ptr[4] & 0x80 ? true : false;
return 0;
}
/**
* hdmi_vendor_infoframe_unpack() - unpack binary buffer to a HDMI vendor infoframe
* @frame: HDMI Vendor infoframe
* @buffer: source buffer
* @size: size of buffer
*
* Unpacks the information contained in binary @buffer into a structured
* @frame of the HDMI Vendor information frame.
* Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns 0 on success or a negative error code on failure.
*/
static int
hdmi_vendor_any_infoframe_unpack(union hdmi_vendor_any_infoframe *frame,
const void *buffer, size_t size)
{
const u8 *ptr = buffer;
size_t length;
int ret;
u8 hdmi_video_format;
struct hdmi_vendor_infoframe *hvf = &frame->hdmi;
if (size < HDMI_INFOFRAME_HEADER_SIZE)
return -EINVAL;
if (ptr[0] != HDMI_INFOFRAME_TYPE_VENDOR ||
ptr[1] != 1 ||
(ptr[2] != 4 && ptr[2] != 5 && ptr[2] != 6))
return -EINVAL;
length = ptr[2];
if (size < HDMI_INFOFRAME_HEADER_SIZE + length)
return -EINVAL;
if (hdmi_infoframe_checksum(buffer,
HDMI_INFOFRAME_HEADER_SIZE + length) != 0)
return -EINVAL;
ptr += HDMI_INFOFRAME_HEADER_SIZE;
/* HDMI OUI */
if ((ptr[0] != 0x03) ||
(ptr[1] != 0x0c) ||
(ptr[2] != 0x00))
return -EINVAL;
hdmi_video_format = ptr[3] >> 5;
if (hdmi_video_format > 0x2)
return -EINVAL;
ret = hdmi_vendor_infoframe_init(hvf);
if (ret)
return ret;
hvf->length = length;
if (hdmi_video_format == 0x2) {
if (length != 5 && length != 6)
return -EINVAL;
hvf->s3d_struct = ptr[4] >> 4;
if (hvf->s3d_struct >= HDMI_3D_STRUCTURE_SIDE_BY_SIDE_HALF) {
if (length != 6)
return -EINVAL;
hvf->s3d_ext_data = ptr[5] >> 4;
}
} else if (hdmi_video_format == 0x1) {
if (length != 5)
return -EINVAL;
hvf->vic = ptr[4];
} else {
if (length != 4)
return -EINVAL;
}
return 0;
}
/**
* hdmi_drm_infoframe_unpack_only() - unpack binary buffer of CTA-861-G DRM
* infoframe DataBytes to a HDMI DRM
* infoframe
* @frame: HDMI DRM infoframe
* @buffer: source buffer
* @size: size of buffer
*
* Unpacks CTA-861-G DRM infoframe DataBytes contained in the binary @buffer
* into a structured @frame of the HDMI Dynamic Range and Mastering (DRM)
* infoframe.
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_drm_infoframe_unpack_only(struct hdmi_drm_infoframe *frame,
const void *buffer, size_t size)
{
const u8 *ptr = buffer;
const u8 *temp;
u8 x_lsb, x_msb;
u8 y_lsb, y_msb;
int ret;
int i;
if (size < HDMI_DRM_INFOFRAME_SIZE)
return -EINVAL;
ret = hdmi_drm_infoframe_init(frame);
if (ret)
return ret;
frame->eotf = ptr[0] & 0x7;
frame->metadata_type = ptr[1] & 0x7;
temp = ptr + 2;
for (i = 0; i < 3; i++) {
x_lsb = *temp++;
x_msb = *temp++;
frame->display_primaries[i].x = (x_msb << 8) | x_lsb;
y_lsb = *temp++;
y_msb = *temp++;
frame->display_primaries[i].y = (y_msb << 8) | y_lsb;
}
frame->white_point.x = (ptr[15] << 8) | ptr[14];
frame->white_point.y = (ptr[17] << 8) | ptr[16];
frame->max_display_mastering_luminance = (ptr[19] << 8) | ptr[18];
frame->min_display_mastering_luminance = (ptr[21] << 8) | ptr[20];
frame->max_cll = (ptr[23] << 8) | ptr[22];
frame->max_fall = (ptr[25] << 8) | ptr[24];
return 0;
}
EXPORT_SYMBOL(hdmi_drm_infoframe_unpack_only);
/**
* hdmi_drm_infoframe_unpack() - unpack binary buffer to a HDMI DRM infoframe
* @frame: HDMI DRM infoframe
* @buffer: source buffer
* @size: size of buffer
*
* Unpacks the CTA-861-G DRM infoframe contained in the binary @buffer into
* a structured @frame of the HDMI Dynamic Range and Mastering (DRM)
* infoframe. It also verifies the checksum as required by section 5.3.5 of
* the HDMI 1.4 specification.
*
* Returns 0 on success or a negative error code on failure.
*/
static int hdmi_drm_infoframe_unpack(struct hdmi_drm_infoframe *frame,
const void *buffer, size_t size)
{
const u8 *ptr = buffer;
int ret;
if (size < HDMI_INFOFRAME_SIZE(DRM))
return -EINVAL;
if (ptr[0] != HDMI_INFOFRAME_TYPE_DRM ||
ptr[1] != 1 ||
ptr[2] != HDMI_DRM_INFOFRAME_SIZE)
return -EINVAL;
if (hdmi_infoframe_checksum(buffer, HDMI_INFOFRAME_SIZE(DRM)) != 0)
return -EINVAL;
ret = hdmi_drm_infoframe_unpack_only(frame, ptr + HDMI_INFOFRAME_HEADER_SIZE,
size - HDMI_INFOFRAME_HEADER_SIZE);
return ret;
}
/**
* hdmi_infoframe_unpack() - unpack binary buffer to a HDMI infoframe
* @frame: HDMI infoframe
* @buffer: source buffer
* @size: size of buffer
*
* Unpacks the information contained in binary buffer @buffer into a structured
* @frame of a HDMI infoframe.
* Also verifies the checksum as required by section 5.3.5 of the HDMI 1.4
* specification.
*
* Returns 0 on success or a negative error code on failure.
*/
int hdmi_infoframe_unpack(union hdmi_infoframe *frame,
const void *buffer, size_t size)
{
int ret;
const u8 *ptr = buffer;
if (size < HDMI_INFOFRAME_HEADER_SIZE)
return -EINVAL;
switch (ptr[0]) {
case HDMI_INFOFRAME_TYPE_AVI:
ret = hdmi_avi_infoframe_unpack(&frame->avi, buffer, size);
break;
case HDMI_INFOFRAME_TYPE_DRM:
ret = hdmi_drm_infoframe_unpack(&frame->drm, buffer, size);
break;
case HDMI_INFOFRAME_TYPE_SPD:
ret = hdmi_spd_infoframe_unpack(&frame->spd, buffer, size);
break;
case HDMI_INFOFRAME_TYPE_AUDIO:
ret = hdmi_audio_infoframe_unpack(&frame->audio, buffer, size);
break;
case HDMI_INFOFRAME_TYPE_VENDOR:
ret = hdmi_vendor_any_infoframe_unpack(&frame->vendor, buffer, size);
break;
default:
ret = -EINVAL;
break;
}
return ret;
}
EXPORT_SYMBOL(hdmi_infoframe_unpack);