[net-next-2.6.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"

/* 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)
{
#if defined(CONFIG_VIDEO_VESA) || defined(CONFIG_FIRMWARE_EDID)
	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 */
#endif /* CONFIG_VIDEO_VESA || CONFIG_FIRMWARE_EDID */
#ifdef CONFIG_VIDEO_VESA
	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;
#else
	return 0;
#endif /* CONFIG_VIDEO_VESA */
}

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