#include <linux/bitfield.h>
#include <linux/byteorder/generic.h>
#include <linux/cec.h>
-#include <linux/gcd.h>
#include <linux/export.h>
#include <linux/hdmi.h>
#include <linux/i2c.h>
{ 2048, 1536, 60, 0 },
};
-struct cta_rid {
- u16 hactive;
- u16 vactive;
- u8 hratio;
- u8 vratio;
-};
-
-/* CTA-861-I Table 11 - Resolution Identification (RID) */
-static const struct cta_rid rids[] = {
- [0] = { 0, 0, 0, 0 },
- [1] = { 1280, 720, 16, 9 },
- [2] = { 1280, 720, 64, 27 },
- [3] = { 1680, 720, 64, 27 },
- [4] = { 1920, 1080, 16, 9 },
- [5] = { 1920, 1080, 64, 27 },
- [6] = { 2560, 1080, 64, 27 },
- [7] = { 3840, 1080, 32, 9 },
- [8] = { 2560, 1440, 16, 9 },
- [9] = { 3440, 1440, 64, 27 },
- [10] = { 5120, 1440, 32, 9 },
- [11] = { 3840, 2160, 16, 9 },
- [12] = { 3840, 2160, 64, 27 },
- [13] = { 5120, 2160, 64, 27 },
- [14] = { 7680, 2160, 32, 9 },
- [15] = { 5120, 2880, 16, 9 },
- [16] = { 5120, 2880, 64, 27 },
- [17] = { 6880, 2880, 64, 27 },
- [18] = { 10240, 2880, 32, 9 },
- [19] = { 7680, 4320, 16, 9 },
- [20] = { 7680, 4320, 64, 27 },
- [21] = { 10240, 4320, 64, 27 },
- [22] = { 15360, 4320, 32, 9 },
- [23] = { 11520, 6480, 16, 9 },
- [24] = { 11520, 6480, 64, 27 },
- [25] = { 15360, 6480, 64, 27 },
- [26] = { 15360, 8640, 16, 9 },
- [27] = { 15360, 8640, 64, 27 },
- [28] = { 20480, 8640, 64, 27 },
-};
-
-/* CTA-861-I Table 12 - AVI InfoFrame Video Format Frame Rate */
-static const u16 video_format_frame_rates[] = {
- /* Frame Rate 0-7 */
- 0, 24, 25, 30, 48, 50, 60, 100,
- /* Frame Rate 8-15 */
- 120, 144, 200, 240, 300, 360, 400, 480,
-};
-
-/* CTA-861-I Table 13 - RID To VIC Mapping */
-static const u8 rid_to_vic[][8] = {
- [0] = {},
- [1] = { 60, 61, 62, 108, 19, 4, 41, 47 },
- [2] = { 65, 66, 67, 109, 68, 69, 70, 71 },
- [3] = { 79, 80, 81, 110, 82, 83, 84, 85 },
- [4] = { 32, 33, 34, 111, 31, 16, 64, 63 },
- [5] = { 72, 73, 74, 112, 75, 76, 77, 78 },
- [6] = { 86, 87, 88, 113, 89, 90, 91, 92 },
- [7] = {},
- [8] = {},
- [9] = {},
- [10] = {},
- [11] = { 93, 94, 95, 114, 96, 97, 117, 118 },
- [12] = { 103, 104, 105, 116, 106, 107, 119, 120 },
- [13] = { 121, 122, 123, 124, 125, 126, 127, 193 },
- [14] = {},
- [15] = {},
- [16] = {},
- [17] = {},
- [18] = {},
- [19] = { 194, 195, 196, 197, 198, 199, 200, 201 },
- [20] = { 202, 203, 204, 205, 206, 207, 208, 209 },
- [21] = { 210, 211, 212, 213, 214, 215, 216, 217 },
- [22] = {},
- [23] = {},
- [24] = {},
- [25] = {},
- [26] = {},
- [27] = {},
- [28] = {},
-};
-
/*
* From CEA/CTA-861 spec.
*
#define CTA_DB_VIDEO 2
#define CTA_DB_VENDOR 3
#define CTA_DB_SPEAKER 4
-#define CTA_DB_VIDEO_FORMAT 6
#define CTA_DB_EXTENDED_TAG 7
/* CTA-861-H Table 62 - CTA Extended Tag Codes */
u8 data[];
} __packed;
-struct cta_vfd {
- u8 rid;
- u8 fr_fact;
- bool bfr50;
- bool fr24;
- bool bfr60;
- bool fr144;
- bool fr48;
-};
-
static int cea_db_tag(const struct cea_db *db)
{
return db->tag_length >> 5;
return cta[4 + 2];
}
-/* CTA-861 Video Format Descriptor (CTA VFD) */
-static void parse_cta_vfd(struct cta_vfd *vfd, const u8 *data, int vfd_len)
-{
- vfd->rid = data[0] & 0x3f;
- vfd->bfr50 = data[0] & 0x80;
- vfd->fr24 = data[0] & 0x40;
- vfd->bfr60 = vfd_len > 1 ? (data[1] & 0x80) : true;
- vfd->fr144 = vfd_len > 1 ? (data[1] & 0x40) : false;
- vfd->fr_fact = vfd_len > 1 ? (data[1] & 0x3f) : 0x3;
- vfd->fr48 = vfd_len > 2 ? (data[2] & 0x1) : false;
-}
-
-static bool vfd_has_fr(const struct cta_vfd *vfd, int rate)
-{
- static const u8 factors[] = {
- 1, 2, 4, 8, 12, 16
- };
- int factor = 0;
- int i;
-
- switch (rate) {
- case 24:
- return vfd->fr24;
- case 48:
- return vfd->fr48;
- case 144:
- return vfd->fr144;
- }
-
- if (!(rate % 25)) {
- if (!vfd->bfr50)
- return false;
-
- factor = rate / 25;
- } else if (!(rate % 30)) {
- if (!vfd->bfr60)
- return false;
-
- factor = rate / 30;
- }
-
- for (i = 0; i < ARRAY_SIZE(factors); i++)
- if (factor == factors[i] && (vfd->fr_fact & (1 << i)))
- return true;
-
- return false;
-}
-
-#define OVT_PIXEL_CLOCK_GRANULARITY 1000 /* Hz */
-#define OVT_MIN_HTOTAL_GRANULARITY 8 /* pixels */
-#define OVT_MIN_VBLANK_DURATION 460000000 /* ps */
-#define OVT_MIN_VBLANK_LINES 20
-#define OVT_MIN_VSYNC_LEADING_EDGE 400 /* us */
-#define OVT_MIN_VSYNC_LE_LINES 14
-#define OVT_MIN_CLOCK_RATE_420 590000000 /* Hz */
-#define OVT_PIXEL_FACTOR_420 2
-#define OVT_MIN_HBLANK_444 80 /* pixels */
-#define OVT_MIN_HBLANK_420 128 /* pixels */
-#define OVT_MAX_CHUNK_RATE 650000000 /* Hz */
-#define OVT_AUDIO_PACKET_RATE 195000 /* Hz */
-#define OVT_AUDIO_PACKET_SIZE 32
-#define OVT_LINE_OVERHEAD 32
-#define OVT_HSYNC_WIDTH 32
-#define OVT_VSYNC_WIDTH 8
-
-static u32 calculate_ovt_min_vtotal(const struct cta_rid *rid, u64 max_vrate,
- u32 vtotal_granularity)
-{
- u64 max_active_time;
- u32 min_line_time;
- u32 min_vblank;
- u32 min_vtotal;
-
- /* step 2 */
- max_active_time = div64_u64(1000000000000, max_vrate) -
- (u64)OVT_MIN_VBLANK_DURATION;
-
- min_line_time = div_u64(max_active_time, rid->vactive);
-
- min_vblank = max_t(u64, (u64)OVT_MIN_VBLANK_LINES,
- DIV64_U64_ROUND_UP(OVT_MIN_VBLANK_DURATION,
- min_line_time));
-
- min_vtotal = rid->vactive + min_vblank;
-
- if (min_vtotal % vtotal_granularity)
- min_vtotal += vtotal_granularity - (min_vtotal %
- vtotal_granularity);
-
- return min_vtotal;
-}
-
-static u32 calculate_ovt_min_htotal(const struct cta_rid *rid,
- const u32 max_vrate,
- const u32 min_vtotal,
- u32 *min_hblank,
- u32 *htotal_granularity)
-{
- u32 max_audio_packets_per_line;
- u32 htotal_granularity_chunk;
- u64 min_pixel_clock_rate;
- u32 min_line_rate;
- u32 min_htotal;
-
- /* step 3 */
- min_line_rate = max_vrate * min_vtotal;
-
- max_audio_packets_per_line = DIV_ROUND_UP(OVT_AUDIO_PACKET_RATE,
- min_line_rate);
-
- /* step 4 */
- *min_hblank = OVT_LINE_OVERHEAD + OVT_AUDIO_PACKET_SIZE *
- max_audio_packets_per_line;
-
- min_htotal = rid->hactive + max(OVT_MIN_HBLANK_444, *min_hblank);
-
- min_pixel_clock_rate = max_vrate * min_htotal * min_vtotal;
-
- htotal_granularity_chunk =
- roundup_pow_of_two(DIV64_U64_ROUND_UP(min_pixel_clock_rate,
- OVT_MAX_CHUNK_RATE));
-
- *htotal_granularity = max(OVT_MIN_HTOTAL_GRANULARITY,
- htotal_granularity_chunk);
-
- if (min_htotal % *htotal_granularity)
- min_htotal += *htotal_granularity - (min_htotal %
- *htotal_granularity);
-
- return min_htotal;
-}
-
-static u64 calculate_ovt_pixel_clock_rate(const struct cta_rid *rid,
- const u32 max_vrate,
- const u32 min_hblank,
- u32 min_htotal,
- u32 min_vtotal,
- const u32 htotal_granularity,
- const u32 vtotal_granularity,
- u32 *htotal, u32 *vtotal)
-{
- u32 resolution_granularity;
- u64 pixel_clock_rate;
- u64 min_resolution;
- u64 rem;
- u32 h;
- u64 r;
- u32 v;
-
- resolution_granularity = OVT_PIXEL_CLOCK_GRANULARITY /
- gcd(OVT_PIXEL_CLOCK_GRANULARITY, max_vrate);
-
- do {
- /* step 5 */
- min_resolution = 0;
- v = min_vtotal;
-
- goto loop_end;
-
- while (!min_resolution || r <= min_resolution) {
- goto inner_loop_end;
-
- while (rem || div64_u64(max_vrate * r, (h & ~(h - 1))) >
- OVT_MAX_CHUNK_RATE) {
- h += htotal_granularity;
- r = (u64)h * (u64)v;
-inner_loop_end:
- div64_u64_rem(r, resolution_granularity, &rem);
- }
-
- if (!min_resolution || r < min_resolution) {
- *htotal = h;
- *vtotal = v;
- min_resolution = r;
- }
-
- v += vtotal_granularity;
-
-loop_end:
- h = min_htotal;
- r = (u64)h * (u64)v;
- }
-
- pixel_clock_rate = max_vrate * min_resolution;
-
- /* step 6 */
- min_htotal = rid->hactive + max(OVT_MIN_HBLANK_420,
- OVT_PIXEL_FACTOR_420 *
- min_hblank);
-
- } while (pixel_clock_rate >= OVT_MIN_CLOCK_RATE_420 &&
- *htotal < min_htotal);
-
- return pixel_clock_rate;
-}
-
-static const struct cta_rid *find_rid(u8 rid)
-{
- if (!rid || rid >= ARRAY_SIZE(rids))
- return NULL;
-
- return &rids[rid];
-}
-
-/* OVT Algorthim as specified in CTA-861-I */
-struct drm_display_mode *drm_ovt_mode(struct drm_device *dev, int r_id,
- int vrefresh)
-{
- const struct cta_rid *rid = find_rid(r_id);
- struct drm_display_mode *mode;
- u32 vtotal_granularity = 1;
- u32 htotal_granularity;
- u32 max_vrate = vrefresh;
- u64 pixel_clock_rate;
- u32 vsync_position;
- u32 min_hblank;
- u32 min_htotal;
- u32 min_vtotal;
- u32 htotal;
- u32 vtotal;
-
- if (!rid)
- return NULL;
-
- /* step 1 */
- switch (vrefresh) {
- case 24:
- case 25:
- max_vrate = 30;
- fallthrough;
- case 30:
- vtotal_granularity = 20;
- break;
- case 48:
- case 50:
- max_vrate = 60;
- fallthrough;
- case 60:
- vtotal_granularity = 20;
- break;
- case 100:
- max_vrate = 120;
- fallthrough;
- case 120:
- vtotal_granularity = 5;
- break;
- case 200:
- max_vrate = 240;
- fallthrough;
- case 240:
- vtotal_granularity = 5;
- break;
- case 300:
- max_vrate = 360;
- fallthrough;
- case 360:
- vtotal_granularity = 5;
- break;
- case 400:
- max_vrate = 480;
- fallthrough;
- case 480:
- vtotal_granularity = 5;
- break;
- }
-
- min_vtotal = calculate_ovt_min_vtotal(rid, max_vrate,
- vtotal_granularity);
-
- min_htotal = calculate_ovt_min_htotal(rid, max_vrate, min_vtotal,
- &min_hblank, &htotal_granularity);
-
- pixel_clock_rate = calculate_ovt_pixel_clock_rate(rid, max_vrate,
- min_hblank,
- min_htotal,
- min_vtotal,
- htotal_granularity,
- vtotal_granularity,
- &htotal, &vtotal);
-
- /* step 7 */
- vtotal = vtotal * max_vrate / (u32)vrefresh;
-
- /* step 8 */
- vsync_position = max(OVT_MIN_VSYNC_LE_LINES,
- DIV64_U64_ROUND_UP((u64)OVT_MIN_VSYNC_LE_LINES *
- pixel_clock_rate,
- (u64)htotal * (u64)1000000));
-
- mode = drm_mode_create(dev);
-
- if (!mode)
- return NULL;
-
- /* step 10 */
- mode->clock = div_u64(pixel_clock_rate, 1000);
- mode->hdisplay = rid->hactive;
- mode->hsync_start = htotal - OVT_HSYNC_WIDTH * 2;
- mode->hsync_end = mode->hsync_start + OVT_HSYNC_WIDTH;
- mode->htotal = htotal;
-
- mode->vdisplay = rid->vactive;
- mode->vsync_start = vtotal - vsync_position;
- mode->vsync_end = mode->vsync_start + OVT_VSYNC_WIDTH;
- mode->vtotal = vtotal;
-
- return mode;
-}
-
-static u8 find_vic(u8 rid, int rate_idx)
-{
- if (video_format_frame_rates[rate_idx] > 120 || !find_rid(rid))
- return 0;
-
- return rid_to_vic[rid][rate_idx - 1];
-}
-
-/* CTA-861 Video Format Data Block (CTA VFDB) */
-static int add_modes_from_vfdb(struct drm_connector *connector,
- const struct cea_db *db)
-{
- const struct drm_display_info *info = &connector->display_info;
- int vfdb_len = cea_db_payload_len(db);
- struct drm_display_mode *mode;
- struct cta_vfd vfd;
- int num_modes = 0;
- int rate_idx;
- int vfd_len;
- int rate;
- int i;
-
- if (!vfdb_len)
- return 0;
-
- vfd_len = (db->data[0] & 0x3);
-
- if (!vfd_len)
- return 0;
-
- vfd_len++;
- vfdb_len--;
- vfdb_len -= (vfdb_len % vfd_len);
-
- for (i = 0; i < vfdb_len; i += vfd_len) {
- parse_cta_vfd(&vfd, &db->data[i + 1], vfd_len);
-
- for (rate_idx = 1; rate_idx <
- ARRAY_SIZE(video_format_frame_rates); rate_idx++) {
- rate = video_format_frame_rates[rate_idx];
-
- if (!vfd_has_fr(&vfd, rate) || find_vic(vfd.rid,
- rate_idx))
- continue;
-
- mode = drm_ovt_mode(connector->dev, vfd.rid, rate);
-
- if (!mode)
- continue;
-
- mode->height_mm = info->height_mm;
- mode->width_mm = info->width_mm;
-
- drm_mode_probed_add(connector, mode);
- num_modes++;
- }
- }
-
- return num_modes;
-}
-
/*
* CTA-861 YCbCr 4:2:0 Capability Map Data Block (CTA Y420CMDB)
*
/* Add 4:2:0(only) modes present in EDID */
modes += do_y420vdb_modes(connector, vdb420,
cea_db_payload_len(db) - 1);
- } else if (cea_db_tag(db) == CTA_DB_VIDEO_FORMAT) {
- modes += add_modes_from_vfdb(connector, db);
}
}
cea_db_iter_end(&iter);
projects / thirdparty / linux.git / commitdiff
