mirror of
https://github.com/CloverHackyColor/CloverBootloader.git
synced 2024-11-24 11:45:27 +01:00
292 lines
7.6 KiB
C
292 lines
7.6 KiB
C
/*
|
|
* edid.c
|
|
*
|
|
*
|
|
* Created by Evan Lojewski on 12/1/09.
|
|
* Copyright 2009. All rights reserved.
|
|
*
|
|
* Slice 2010, based on Joblo works
|
|
*/
|
|
|
|
|
|
#include "VideoBiosPatchLibInternal.h"
|
|
//#include "libsaio.h"
|
|
//#include "edid.h"
|
|
//#include "vbe.h"
|
|
//#include "graphics.h"
|
|
//#include "boot.h"
|
|
//----------------------------------------------------------------------------------
|
|
|
|
#define FBMON_FIX_HEADER 1
|
|
#define FBMON_FIX_INPUT 2
|
|
//#define ARRAY_SIZE(x) (sizeof(x) / sizeof((x)[0])) //defined in EDK2 since 23000
|
|
|
|
#define DEFAULT_SCREEN_WIDTH 1024
|
|
#define DEFAULT_SCREEN_HEIGHT 600
|
|
|
|
//#include <Protocol/EdidActive.h>
|
|
#include <Protocol/EdidDiscovered.h>
|
|
|
|
//----------------------------------------------------------------------------------
|
|
/*
|
|
struct broken_edid {
|
|
const CHAR8 manufacturer[4];
|
|
UINT32 model;
|
|
UINT32 fix;
|
|
};
|
|
|
|
//----------------------------------------------------------------------------------
|
|
|
|
broken_edid brokendb[] = {
|
|
// DEC FR-PCXAV-YZ *
|
|
{ "DEC", 0x073a, FBMON_FIX_HEADER,},
|
|
// ViewSonic PF775a *
|
|
{ "VSC", 0x5a44, FBMON_FIX_INPUT, }
|
|
};
|
|
//----------------------------------------------------------------------------------
|
|
*/
|
|
const UINT8 edid_v1_header[] = { 0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00 };
|
|
|
|
//----------------------------------------------------------------------------------
|
|
/*
|
|
INT32 check_edid(UINT8 *edid)
|
|
{
|
|
UINT8 *block = edid + ID_MANUFACTURER_NAME, manufacturer[4];
|
|
//UINT8 *b;
|
|
UINT32 model;
|
|
//INT32 i, fix = 0, ret = 0;
|
|
|
|
manufacturer[0] = ((block[0] & 0x7c) >> 2) + '@';
|
|
manufacturer[1] = ((block[0] & 0x03) << 3) +
|
|
((block[1] & 0xe0) >> 5) + '@';
|
|
manufacturer[2] = (block[1] & 0x1f) + '@';
|
|
manufacturer[3] = 0;
|
|
model = block[2] + (block[3] << 8);
|
|
//
|
|
for (i = 0; i < (int)ARRAY_SIZE(brokendb); i++) {
|
|
if (!strncmp((const CHAR8 *)manufacturer, brokendb[i].manufacturer, 4) &&
|
|
brokendb[i].model == model) {
|
|
DEBG("ATIFB: The EDID Block of "
|
|
"Manufacturer: %s Model: 0x%08lx is known to "
|
|
"be broken,\n", manufacturer, model);
|
|
fix = brokendb[i].fix;
|
|
break;
|
|
}
|
|
}
|
|
|
|
switch (fix) {
|
|
case FBMON_FIX_HEADER:
|
|
for (i = 0; i < 8; i++) {
|
|
if (edid[i] != edid_v1_header[i])
|
|
ret = fix;
|
|
}
|
|
break;
|
|
case FBMON_FIX_INPUT:
|
|
b = edid + EDID_STRUCT_DISPLAY;
|
|
/// Only if display is GTF capable will
|
|
//the input type be reset to analog *
|
|
if (b[4] & 0x01 && b[0] & 0x80)
|
|
ret = fix;
|
|
break;
|
|
}
|
|
//
|
|
return 0; //ret;
|
|
}
|
|
*/
|
|
//----------------------------------------------------------------------------------
|
|
/*
|
|
static VOID fix_edid(UINT8 *edid, INT32 fix)
|
|
{
|
|
UINT8 *b;
|
|
|
|
switch (fix) {
|
|
case FBMON_FIX_HEADER:
|
|
DBG(" EDID: trying a header reconstruct\n");
|
|
CopyMem(edid, edid_v1_header, 8);
|
|
break;
|
|
case FBMON_FIX_INPUT:
|
|
DBG(" EDID: trying to fix input type\n");
|
|
b = edid + EDID_STRUCT_DISPLAY;
|
|
b[0] &= ~0x80;
|
|
edid[127] += 0x80;
|
|
}
|
|
}
|
|
*/
|
|
//----------------------------------------------------------------------------------
|
|
|
|
INT32 edid_checksum(UINT8 *edid)
|
|
{
|
|
UINT8 i, csum = 0, all_null = 0;
|
|
INT32 err = 0;
|
|
|
|
for (i = 0; i < EDID_LENGTH; i++) {
|
|
csum += edid[i];
|
|
all_null |= edid[i];
|
|
}
|
|
|
|
if (csum == 0x00 && all_null) {
|
|
/* checksum passed, everything's good */
|
|
err = 1;
|
|
} else {
|
|
DBG(" edid_checksum error ");
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
//----------------------------------------------------------------------------------
|
|
|
|
static INT32 edid_check_header(UINT8 *edid)
|
|
{
|
|
INT32 i, err = 1;
|
|
|
|
for (i = 0; i < 8; i++) {
|
|
if (edid[i] != edid_v1_header[i])
|
|
err = 0;
|
|
}
|
|
|
|
if (err == 0) {
|
|
DBG(" edid_check_header error ");
|
|
}
|
|
|
|
return err;
|
|
}
|
|
//------------------------------------------------------------------------
|
|
BOOLEAN verifyEDID(UINT8 *edid)
|
|
{
|
|
if (edid == NULL || !edid_checksum(edid) || !edid_check_header(edid))
|
|
{
|
|
return FALSE;
|
|
}
|
|
return TRUE;
|
|
}
|
|
|
|
INT32 edid_is_timing_block(UINT8 *block)
|
|
{
|
|
if ((block[0] != 0x00) || (block[1] != 0x00) ||
|
|
(block[2] != 0x00) || (block[4] != 0x00))
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
//----------------------------------------------------------------------------------
|
|
|
|
INT32 fb_parse_edid(struct EDID *edid, edid_mode* var) //(struct EDID *edid, UINT32* x, UINT32* y)
|
|
{
|
|
INT32 i;
|
|
UINT8 *block;
|
|
|
|
DBG(" Parse Edid:");
|
|
if(!verifyEDID((UINT8 *)edid)) {
|
|
DBG(" error\n");
|
|
return 0;
|
|
}
|
|
|
|
block = (UINT8 *)edid + DETAILED_TIMING_DESCRIPTIONS_START; //54
|
|
|
|
for (i = 0; i < 4; i++, block += DETAILED_TIMING_DESCRIPTION_SIZE) {
|
|
if (edid_is_timing_block(block)) {
|
|
DBG(" descriptor block %d is timing descriptor ", i);
|
|
var->h_active = H_ACTIVE;
|
|
var->v_active = V_ACTIVE;
|
|
var->h_sync_offset = H_SYNC_OFFSET;
|
|
var->h_sync_width = H_SYNC_WIDTH;
|
|
var->h_blanking = H_BLANKING;
|
|
var->v_blanking = V_BLANKING;
|
|
var->pixel_clock = PIXEL_CLOCK;
|
|
var->v_sync_offset = V_SYNC_OFFSET;
|
|
var->v_sync_width = V_SYNC_WIDTH;
|
|
DBG("(h_active: %d, v_active: %d, h_sync_offset: %d, h_sync_width: %d",
|
|
var->h_active, var->v_active, var->h_sync_offset, var->h_sync_width);
|
|
DBG(", h_blanking: %d, v_blanking: %d, pixel_clock: %d, v_sync_offset: %d, v_sync_width: %d)\n",
|
|
var->h_blanking, var->v_blanking, var->pixel_clock, var->v_sync_offset, var->v_sync_width);
|
|
/*
|
|
var->xres = var->xres_virtual = H_ACTIVE;
|
|
var->yres = var->yres_virtual = V_ACTIVE;
|
|
var->height = var->width = -1;
|
|
var->right_margin = H_SYNC_OFFSET;
|
|
var->left_margin = (H_ACTIVE + H_BLANKING) -
|
|
(H_ACTIVE + H_SYNC_OFFSET + H_SYNC_WIDTH);
|
|
var->upper_margin = V_BLANKING - V_SYNC_OFFSET -
|
|
V_SYNC_WIDTH;
|
|
var->lower_margin = V_SYNC_OFFSET;
|
|
var->hsync_len = H_SYNC_WIDTH;
|
|
var->vsync_len = V_SYNC_WIDTH;
|
|
var->pixclock = PIXEL_CLOCK;
|
|
var->pixclock /= 1000;
|
|
var->pixclock = KHZ2PICOS(var->pixclock);
|
|
|
|
if (HSYNC_POSITIVE)
|
|
var->sync |= FB_SYNC_HOR_HIGH_ACT;
|
|
if (VSYNC_POSITIVE)
|
|
var->sync |= FB_SYNC_VERT_HIGH_ACT;
|
|
*/
|
|
return 1;
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
VOID getResolution(UINT32* x, UINT32* y, UINT32* bp)
|
|
{
|
|
// INT32 val;
|
|
static UINT32 xResolution, yResolution, bpResolution = 32; // assume 32bits
|
|
|
|
edid_mode mode;
|
|
CHAR8* edidInfo = readEDID();
|
|
|
|
if(!edidInfo) return;
|
|
// TODO: check *all* resolutions reported and either use the highest, or the native resolution (if there is a flag for that)
|
|
//xResolution = edidInfo[56] | ((edidInfo[58] & 0xF0) << 4);
|
|
//yResolution = edidInfo[59] | ((edidInfo[61] & 0xF0) << 4);
|
|
//Slice - done here
|
|
|
|
if(fb_parse_edid((struct EDID *)edidInfo, &mode) == 0)
|
|
{
|
|
xResolution = DEFAULT_SCREEN_WIDTH;
|
|
yResolution = DEFAULT_SCREEN_HEIGHT;
|
|
}
|
|
else {
|
|
xResolution = mode.h_active;
|
|
yResolution = mode.v_active;
|
|
}
|
|
|
|
/*
|
|
0x00 0xFF 0xFF 0xFF 0xFF 0xFF 0xFF 0x00 0x32 0x0C
|
|
0x00 0xDF 0x00 0x00 0x00 0x00 0xFF 0xFF 0xFF 0x00
|
|
0x0C 0xDF 0x00 0x00 0x12 0x03 0x21 0x78 0xE9 0x99
|
|
0x53 0x28 0xFF 0xFF 0x32 0xDF 0x00 0x12 0x80 0x78
|
|
0xD5 0x53 0x26 0x00 0x01 0x01 0x01 0x01 0xFF 0x00
|
|
0xDF 0x00 0x03 0x78 0x99 0x28 0x00 0x01 0x01 0x01
|
|
0x01 0x21 0x84 0x20 0xFF 0x0C 0x00 0x03 0x0A 0x53
|
|
0x54 0x01 0x01 0x01 0xDE 0x84 0x56 0x00 0xA0 0x30
|
|
0xFF 0xDF 0x12 0x78 0x53 0x00 0x01 0x01 0x01 0x84
|
|
0x00 0x18 0x84 0x00 0x00 0x57 0xFF 0x00 0x80 0x99
|
|
0x54 0x01 0x01 0x21 0x20 0x00 0x50 0x00 0x00 0x35
|
|
0x57 0xFE 0x00 0x00 0x78 0x28 0x01 0x01 0x21 0x20
|
|
0x18 0x30 0x00 0x57 0x34 0xFE 0xAA 0x9A
|
|
|
|
*/
|
|
|
|
//DBG("H Active = %d ", edidInfo[56] | ((edidInfo[58] & 0xF0) << 4) );
|
|
//DBG("V Active = %d \n", edidInfo[59] | ((edidInfo[61] & 0xF0) << 4) );
|
|
|
|
FreePool( edidInfo );
|
|
|
|
//if(!xResolution) xResolution = DEFAULT_SCREEN_WIDTH;
|
|
//if(!yResolution) yResolution = DEFAULT_SCREEN_HEIGHT;
|
|
|
|
|
|
|
|
*x = xResolution;
|
|
*y = yResolution;
|
|
*bp = bpResolution;
|
|
|
|
DBG("Best mode: %dx%dx%d\n", *x, *y, *bp);
|
|
}
|
|
|
|
CHAR8* readEDID(VOID)
|
|
{
|
|
return (CHAR8*) mEdid;
|
|
}
|