[mirror_ubuntu-bionic-kernel.git] / arch / x86 / boot / video-vesa.c

/* -*- linux-c -*- ------------------------------------------------------- *
 *
 *   Copyright (C) 1991, 1992 Linus Torvalds
 *   Copyright 2007 rPath, Inc. - All Rights Reserved
 *   Copyright 2009 Intel Corporation; author H. Peter Anvin
 *
 *   This file is part of the Linux kernel, and is made available under
 *   the terms of the GNU General Public License version 2.
 *
 * ----------------------------------------------------------------------- */

/*
 * VESA text modes
 */

#include "boot.h"
#include "video.h"
#include "vesa.h"
#include "string.h"

/* VESA information */
static struct vesa_general_info vginfo;
static struct vesa_mode_info vminfo;

static __videocard video_vesa;

#ifndef _WAKEUP
static void vesa_store_mode_params_graphics(void);
#else /* _WAKEUP */
static inline void vesa_store_mode_params_graphics(void) {}
#endif /* _WAKEUP */

static int vesa_probe(void)
{
	struct biosregs ireg, oreg;
	u16 mode;
	addr_t mode_ptr;
	struct mode_info *mi;
	int nmodes = 0;

	video_vesa.modes = GET_HEAP(struct mode_info, 0);

	initregs(&ireg);
	ireg.ax = 0x4f00;
	ireg.di = (size_t)&vginfo;
	intcall(0x10, &ireg, &oreg);

	if (oreg.ax != 0x004f ||
	    vginfo.signature != VESA_MAGIC ||
	    vginfo.version < 0x0102)
		return 0;	/* Not present */

	set_fs(vginfo.video_mode_ptr.seg);
	mode_ptr = vginfo.video_mode_ptr.off;

	while ((mode = rdfs16(mode_ptr)) != 0xffff) {
		mode_ptr += 2;

		if (!heap_free(sizeof(struct mode_info)))
			break;	/* Heap full, can't save mode info */

		if (mode & ~0x1ff)
			continue;

		memset(&vminfo, 0, sizeof vminfo); /* Just in case... */

		ireg.ax = 0x4f01;
		ireg.cx = mode;
		ireg.di = (size_t)&vminfo;
		intcall(0x10, &ireg, &oreg);

		if (oreg.ax != 0x004f)
			continue;

		if ((vminfo.mode_attr & 0x15) == 0x05) {
			/* Text Mode, TTY BIOS supported,
			   supported by hardware */
			mi = GET_HEAP(struct mode_info, 1);
			mi->mode  = mode + VIDEO_FIRST_VESA;
			mi->depth = 0; /* text */
			mi->x     = vminfo.h_res;
			mi->y     = vminfo.v_res;
			nmodes++;
		} else if ((vminfo.mode_attr & 0x99) == 0x99 &&
			   (vminfo.memory_layout == 4 ||
			    vminfo.memory_layout == 6) &&
			   vminfo.memory_planes == 1) {
#ifdef CONFIG_FB_BOOT_VESA_SUPPORT
			/* Graphics mode, color, linear frame buffer
			   supported.  Only register the mode if
			   if framebuffer is configured, however,
			   otherwise the user will be left without a screen. */
			mi = GET_HEAP(struct mode_info, 1);
			mi->mode = mode + VIDEO_FIRST_VESA;
			mi->depth = vminfo.bpp;
			mi->x = vminfo.h_res;
			mi->y = vminfo.v_res;
			nmodes++;
#endif
		}
	}

	return nmodes;
}

static int vesa_set_mode(struct mode_info *mode)
{
	struct biosregs ireg, oreg;
	int is_graphic;
	u16 vesa_mode = mode->mode - VIDEO_FIRST_VESA;

	memset(&vminfo, 0, sizeof vminfo); /* Just in case... */

	initregs(&ireg);
	ireg.ax = 0x4f01;
	ireg.cx = vesa_mode;
	ireg.di = (size_t)&vminfo;
	intcall(0x10, &ireg, &oreg);

	if (oreg.ax != 0x004f)
		return -1;

	if ((vminfo.mode_attr & 0x15) == 0x05) {
		/* It's a supported text mode */
		is_graphic = 0;
#ifdef CONFIG_FB_BOOT_VESA_SUPPORT
	} else if ((vminfo.mode_attr & 0x99) == 0x99) {
		/* It's a graphics mode with linear frame buffer */
		is_graphic = 1;
		vesa_mode |= 0x4000; /* Request linear frame buffer */
#endif
	} else {
		return -1;	/* Invalid mode */
	}


	initregs(&ireg);
	ireg.ax = 0x4f02;
	ireg.bx = vesa_mode;
	intcall(0x10, &ireg, &oreg);

	if (oreg.ax != 0x004f)
		return -1;

	graphic_mode = is_graphic;
	if (!is_graphic) {
		/* Text mode */
		force_x = mode->x;
		force_y = mode->y;
		do_restore = 1;
	} else {
		/* Graphics mode */
		vesa_store_mode_params_graphics();
	}

	return 0;
}


#ifndef _WAKEUP

/* Switch DAC to 8-bit mode */
static void vesa_dac_set_8bits(void)
{
	struct biosregs ireg, oreg;
	u8 dac_size = 6;

	/* If possible, switch the DAC to 8-bit mode */
	if (vginfo.capabilities & 1) {
		initregs(&ireg);
		ireg.ax = 0x4f08;
		ireg.bh = 0x08;
		intcall(0x10, &ireg, &oreg);
		if (oreg.ax == 0x004f)
			dac_size = oreg.bh;
	}

	/* Set the color sizes to the DAC size, and offsets to 0 */
	boot_params.screen_info.red_size   = dac_size;
	boot_params.screen_info.green_size = dac_size;
	boot_params.screen_info.blue_size  = dac_size;
	boot_params.screen_info.rsvd_size  = dac_size;

	boot_params.screen_info.red_pos    = 0;
	boot_params.screen_info.green_pos  = 0;
	boot_params.screen_info.blue_pos   = 0;
	boot_params.screen_info.rsvd_pos   = 0;
}

/* Save the VESA protected mode info */
static void vesa_store_pm_info(void)
{
	struct biosregs ireg, oreg;

	initregs(&ireg);
	ireg.ax = 0x4f0a;
	intcall(0x10, &ireg, &oreg);

	if (oreg.ax != 0x004f)
		return;

	boot_params.screen_info.vesapm_seg = oreg.es;
	boot_params.screen_info.vesapm_off = oreg.di;
}

/*
 * Save video mode parameters for graphics mode
 */
static void vesa_store_mode_params_graphics(void)
{
	/* Tell the kernel we're in VESA graphics mode */
	boot_params.screen_info.orig_video_isVGA = VIDEO_TYPE_VLFB;

	/* Mode parameters */
	boot_params.screen_info.vesa_attributes = vminfo.mode_attr;
	boot_params.screen_info.lfb_linelength = vminfo.logical_scan;
	boot_params.screen_info.lfb_width = vminfo.h_res;
	boot_params.screen_info.lfb_height = vminfo.v_res;
	boot_params.screen_info.lfb_depth = vminfo.bpp;
	boot_params.screen_info.pages = vminfo.image_planes;
	boot_params.screen_info.lfb_base = vminfo.lfb_ptr;
	memcpy(&boot_params.screen_info.red_size,
	       &vminfo.rmask, 8);

	/* General parameters */
	boot_params.screen_info.lfb_size = vginfo.total_memory;

	if (vminfo.bpp <= 8)
		vesa_dac_set_8bits();

	vesa_store_pm_info();
}

/*
 * Save EDID information for the kernel; this is invoked, separately,
 * after mode-setting.
 */
void vesa_store_edid(void)
{
#ifdef CONFIG_FIRMWARE_EDID
	struct biosregs ireg, oreg;

	/* Apparently used as a nonsense token... */
	memset(&boot_params.edid_info, 0x13, sizeof boot_params.edid_info);

	if (vginfo.version < 0x0200)
		return;		/* EDID requires VBE 2.0+ */

	initregs(&ireg);
	ireg.ax = 0x4f15;		/* VBE DDC */
	/* ireg.bx = 0x0000; */		/* Report DDC capabilities */
	/* ireg.cx = 0;	*/		/* Controller 0 */
	ireg.es = 0;			/* ES:DI must be 0 by spec */
	intcall(0x10, &ireg, &oreg);

	if (oreg.ax != 0x004f)
		return;		/* No EDID */

	/* BH = time in seconds to transfer EDD information */
	/* BL = DDC level supported */

	ireg.ax = 0x4f15;		/* VBE DDC */
	ireg.bx = 0x0001;		/* Read EDID */
	/* ireg.cx = 0; */		/* Controller 0 */
	/* ireg.dx = 0;	*/		/* EDID block number */
	ireg.es = ds();
	ireg.di =(size_t)&boot_params.edid_info; /* (ES:)Pointer to block */
	intcall(0x10, &ireg, &oreg);
#endif /* CONFIG_FIRMWARE_EDID */
}

#endif /* not _WAKEUP */

static __videocard video_vesa =
{
	.card_name	= "VESA",
	.probe		= vesa_probe,
	.set_mode	= vesa_set_mode,
	.xmode_first	= VIDEO_FIRST_VESA,
	.xmode_n	= 0x200,
};
Commit	Line	Data
5e8ddcbe PA	1	/* -- linux-c -- ------------------------------------------------------- *
	2	*
	3	* Copyright (C) 1991, 1992 Linus Torvalds
	4	* Copyright 2007 rPath, Inc. - All Rights Reserved
cf06de7b	5	* Copyright 2009 Intel Corporation; author H. Peter Anvin
5e8ddcbe PA	6	*
	7	* This file is part of the Linux kernel, and is made available under
	8	* the terms of the GNU General Public License version 2.
	9	*
	10	* ----------------------------------------------------------------------- */
	11
	12	/*
5e8ddcbe PA	13	* VESA text modes
	14	*/
	15
	16	#include "boot.h"
	17	#include "video.h"
	18	#include "vesa.h"
c041b5ad	19	#include "string.h"
5e8ddcbe PA	20
	21	/* VESA information */
	22	static struct vesa_general_info vginfo;
	23	static struct vesa_mode_info vminfo;
	24
8bcad30f	25	static __videocard video_vesa;
5e8ddcbe	26
e44b7b75	27	#ifndef _WAKEUP
5e8ddcbe	28	static void vesa_store_mode_params_graphics(void);
e44b7b75 PM	29	#else /* _WAKEUP */
	30	static inline void vesa_store_mode_params_graphics(void) {}
	31	#endif /* _WAKEUP */
5e8ddcbe PA	32
	33	static int vesa_probe(void)
	34	{
cf06de7b	35	struct biosregs ireg, oreg;
5e8ddcbe PA	36	u16 mode;
	37	addr_t mode_ptr;
	38	struct mode_info *mi;
	39	int nmodes = 0;
	40
	41	video_vesa.modes = GET_HEAP(struct mode_info, 0);
	42
cf06de7b PA	43	initregs(&ireg);
	44	ireg.ax = 0x4f00;
	45	ireg.di = (size_t)&vginfo;
	46	intcall(0x10, &ireg, &oreg);
5e8ddcbe	47
febe04de	48	if (oreg.ax != 0x004f \|\|
5e8ddcbe PA	49	vginfo.signature != VESA_MAGIC \|\|
	50	vginfo.version < 0x0102)
	51	return 0; /* Not present */
2495fbf7	52
5e8ddcbe PA	53	set_fs(vginfo.video_mode_ptr.seg);
	54	mode_ptr = vginfo.video_mode_ptr.off;
	55
	56	while ((mode = rdfs16(mode_ptr)) != 0xffff) {
	57	mode_ptr += 2;
	58
e6e1ace9	59	if (!heap_free(sizeof(struct mode_info)))
5e8ddcbe PA	60	break; /* Heap full, can't save mode info */
	61
	62	if (mode & ~0x1ff)
	63	continue;
	64
	65	memset(&vminfo, 0, sizeof vminfo); /* Just in case... */
	66
cf06de7b PA	67	ireg.ax = 0x4f01;
	68	ireg.cx = mode;
	69	ireg.di = (size_t)&vminfo;
	70	intcall(0x10, &ireg, &oreg);
5e8ddcbe	71
febe04de	72	if (oreg.ax != 0x004f)
5e8ddcbe PA	73	continue;
	74
	75	if ((vminfo.mode_attr & 0x15) == 0x05) {
	76	/* Text Mode, TTY BIOS supported,
	77	supported by hardware */
	78	mi = GET_HEAP(struct mode_info, 1);
1cac5004 PA	79	mi->mode = mode + VIDEO_FIRST_VESA;
	80	mi->depth = 0; /* text */
	81	mi->x = vminfo.h_res;
	82	mi->y = vminfo.v_res;
5e8ddcbe	83	nmodes++;
1cac5004 PA	84	} else if ((vminfo.mode_attr & 0x99) == 0x99 &&
	85	(vminfo.memory_layout == 4 \|\|
	86	vminfo.memory_layout == 6) &&
	87	vminfo.memory_planes == 1) {
4d31a2b7	88	#ifdef CONFIG_FB_BOOT_VESA_SUPPORT
5e8ddcbe	89	/* Graphics mode, color, linear frame buffer
1cac5004 PA	90	supported. Only register the mode if
1cac5004 PA	91	if framebuffer is configured, however,
4d31a2b7	92	otherwise the user will be left without a screen. */
5e8ddcbe PA	93	mi = GET_HEAP(struct mode_info, 1);
5e8ddcbe PA	94	mi->mode = mode + VIDEO_FIRST_VESA;
1cac5004 PA	95	mi->depth = vminfo.bpp;
	96	mi->x = vminfo.h_res;
	97	mi->y = vminfo.v_res;
5e8ddcbe PA	98	nmodes++;
	99	#endif
	100	}
	101	}
	102
	103	return nmodes;
5e8ddcbe PA	104	}
	105
	106	static int vesa_set_mode(struct mode_info *mode)
	107	{
cf06de7b	108	struct biosregs ireg, oreg;
5e8ddcbe PA	109	int is_graphic;
	110	u16 vesa_mode = mode->mode - VIDEO_FIRST_VESA;
	111
	112	memset(&vminfo, 0, sizeof vminfo); /* Just in case... */
	113
cf06de7b PA	114	initregs(&ireg);
	115	ireg.ax = 0x4f01;
	116	ireg.cx = vesa_mode;
	117	ireg.di = (size_t)&vminfo;
	118	intcall(0x10, &ireg, &oreg);
5e8ddcbe	119
cf06de7b	120	if (oreg.ax != 0x004f)
5e8ddcbe PA	121	return -1;
	122
	123	if ((vminfo.mode_attr & 0x15) == 0x05) {
	124	/* It's a supported text mode */
	125	is_graphic = 0;
4d31a2b7	126	#ifdef CONFIG_FB_BOOT_VESA_SUPPORT
5e8ddcbe PA	127	} else if ((vminfo.mode_attr & 0x99) == 0x99) {
	128	/* It's a graphics mode with linear frame buffer */
	129	is_graphic = 1;
	130	vesa_mode \|= 0x4000; /* Request linear frame buffer */
4d31a2b7	131	#endif
5e8ddcbe PA	132	} else {
	133	return -1; /* Invalid mode */
	134	}
	135
	136
cf06de7b PA	137	initregs(&ireg);
	138	ireg.ax = 0x4f02;
	139	ireg.bx = vesa_mode;
	140	intcall(0x10, &ireg, &oreg);
5e8ddcbe	141
cf06de7b	142	if (oreg.ax != 0x004f)
5e8ddcbe PA	143	return -1;
	144
	145	graphic_mode = is_graphic;
	146	if (!is_graphic) {
	147	/* Text mode */
	148	force_x = mode->x;
	149	force_y = mode->y;
	150	do_restore = 1;
	151	} else {
	152	/* Graphics mode */
	153	vesa_store_mode_params_graphics();
	154	}
	155
	156	return 0;
	157	}
	158
	159
e44b7b75 PM	160	#ifndef _WAKEUP
e44b7b75 PM	161
5e8ddcbe PA	162	/* Switch DAC to 8-bit mode */
	163	static void vesa_dac_set_8bits(void)
	164	{
cf06de7b	165	struct biosregs ireg, oreg;
5e8ddcbe PA	166	u8 dac_size = 6;
	167
	168	/* If possible, switch the DAC to 8-bit mode */
	169	if (vginfo.capabilities & 1) {
cf06de7b PA	170	initregs(&ireg);
	171	ireg.ax = 0x4f08;
	172	ireg.bh = 0x08;
	173	intcall(0x10, &ireg, &oreg);
	174	if (oreg.ax == 0x004f)
	175	dac_size = oreg.bh;
5e8ddcbe PA	176	}
	177
	178	/* Set the color sizes to the DAC size, and offsets to 0 */
cf06de7b	179	boot_params.screen_info.red_size = dac_size;
5e8ddcbe	180	boot_params.screen_info.green_size = dac_size;
cf06de7b PA	181	boot_params.screen_info.blue_size = dac_size;
cf06de7b PA	182	boot_params.screen_info.rsvd_size = dac_size;
5e8ddcbe	183
cf06de7b PA	184	boot_params.screen_info.red_pos = 0;
	185	boot_params.screen_info.green_pos = 0;
	186	boot_params.screen_info.blue_pos = 0;
	187	boot_params.screen_info.rsvd_pos = 0;
5e8ddcbe PA	188	}
	189
	190	/* Save the VESA protected mode info */
	191	static void vesa_store_pm_info(void)
	192	{
cf06de7b	193	struct biosregs ireg, oreg;
5e8ddcbe	194
cf06de7b PA	195	initregs(&ireg);
	196	ireg.ax = 0x4f0a;
	197	intcall(0x10, &ireg, &oreg);
5e8ddcbe	198
cf06de7b	199	if (oreg.ax != 0x004f)
5e8ddcbe PA	200	return;
5e8ddcbe PA	201
cf06de7b PA	202	boot_params.screen_info.vesapm_seg = oreg.es;
cf06de7b PA	203	boot_params.screen_info.vesapm_off = oreg.di;
5e8ddcbe PA	204	}
	205
	206	/*
	207	* Save video mode parameters for graphics mode
	208	*/
	209	static void vesa_store_mode_params_graphics(void)
	210	{
	211	/* Tell the kernel we're in VESA graphics mode */
2407390b	212	boot_params.screen_info.orig_video_isVGA = VIDEO_TYPE_VLFB;
5e8ddcbe PA	213
	214	/* Mode parameters */
	215	boot_params.screen_info.vesa_attributes = vminfo.mode_attr;
	216	boot_params.screen_info.lfb_linelength = vminfo.logical_scan;
	217	boot_params.screen_info.lfb_width = vminfo.h_res;
	218	boot_params.screen_info.lfb_height = vminfo.v_res;
	219	boot_params.screen_info.lfb_depth = vminfo.bpp;
	220	boot_params.screen_info.pages = vminfo.image_planes;
	221	boot_params.screen_info.lfb_base = vminfo.lfb_ptr;
	222	memcpy(&boot_params.screen_info.red_size,
	223	&vminfo.rmask, 8);
	224
	225	/* General parameters */
	226	boot_params.screen_info.lfb_size = vginfo.total_memory;
	227
	228	if (vminfo.bpp <= 8)
	229	vesa_dac_set_8bits();
	230
	231	vesa_store_pm_info();
	232	}
	233
	234	/*
	235	* Save EDID information for the kernel; this is invoked, separately,
	236	* after mode-setting.
	237	*/
	238	void vesa_store_edid(void)
	239	{
	240	#ifdef CONFIG_FIRMWARE_EDID
cf06de7b	241	struct biosregs ireg, oreg;
5e8ddcbe PA	242
	243	/* Apparently used as a nonsense token... */
	244	memset(&boot_params.edid_info, 0x13, sizeof boot_params.edid_info);
	245
	246	if (vginfo.version < 0x0200)
	247	return; /* EDID requires VBE 2.0+ */
	248
cf06de7b PA	249	initregs(&ireg);
	250	ireg.ax = 0x4f15; /* VBE DDC */
	251	/* ireg.bx = 0x0000; / / Report DDC capabilities */
	252	/* ireg.cx = 0; / / Controller 0 */
	253	ireg.es = 0; /* ES:DI must be 0 by spec */
	254	intcall(0x10, &ireg, &oreg);
5e8ddcbe	255
cf06de7b	256	if (oreg.ax != 0x004f)
5e8ddcbe PA	257	return; /* No EDID */
	258
	259	/* BH = time in seconds to transfer EDD information */
	260	/* BL = DDC level supported */
	261
cf06de7b PA	262	ireg.ax = 0x4f15; /* VBE DDC */
	263	ireg.bx = 0x0001; /* Read EDID */
	264	/* ireg.cx = 0; / / Controller 0 */
	265	/* ireg.dx = 0; / / EDID block number */
	266	ireg.es = ds();
	267	ireg.di =(size_t)&boot_params.edid_info; /* (ES:)Pointer to block */
	268	intcall(0x10, &ireg, &oreg);
5e8ddcbe PA	269	#endif /* CONFIG_FIRMWARE_EDID */
	270	}
	271
e44b7b75 PM	272	#endif /* not _WAKEUP */
e44b7b75 PM	273
8bcad30f	274	static __videocard video_vesa =
5e8ddcbe PA	275	{
	276	.card_name = "VESA",
	277	.probe = vesa_probe,
	278	.set_mode = vesa_set_mode,
	279	.xmode_first = VIDEO_FIRST_VESA,
	280	.xmode_n = 0x200,
	281	};