* Copyright (c) 2009 Jared D. McNeill <jmcneill@invisible.ca>

/* $NetBSD: biosvbe.S,v 1.3 2011/02/20 22:03:13 jakllsch Exp $ */

/*-
* Copyright (c) 2009 Jared D. McNeill <[email protected]>
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/

#include <machine/asm.h>

.text

/*
* VESA BIOS Extensions routines
*/

/*
* Function 00h - Return VBE Controller Information
*
* int biosvbe_info(struct vbeinfoblock *)
* return: VBE call status
*/
ENTRY(biosvbe_info)
pushl %ebp
movl %esp,%ebp
pushl %ebx
pushl %ecx
pushl %edx
push %esi
push %edi

movl 8(%ebp), %edi /* vbe info block address*/

call _C_LABEL(prot_to_real)
.code16

push %es

push %di
shrl $4, %edi
mov %ds, %ax
add %di, %ax
mov %ax, %es
pop %di
and $0xf, %di /* mode info block address now in es:di */

movw $0x4f00, %ax /* get vbe info block */
int $0x10

pop %es

calll _C_LABEL(real_to_prot)
.code32

andl $0xffff,%eax

pop %edi
pop %esi
popl %edx
popl %ecx
popl %ebx
popl %ebp
ret

/*
* Function 01h - Return VBE Mode Information
*
* int biosvbe_get_mode_info(int mode, struct modeinfoblock *mi)
* return: VBE call status
*/
ENTRY(biosvbe_get_mode_info)
pushl %ebp
movl %esp,%ebp
pushl %ebx
pushl %ecx
pushl %edx
push %esi
push %edi

movl 8(%ebp), %ecx /* mode number */
movl 12(%ebp), %edi /* mode info block address */

call _C_LABEL(prot_to_real)
.code16

push %es

push %di
shrl $4, %edi
mov %ds, %ax
add %di, %ax
mov %ax, %es
pop %di
and $0xf, %di /* mode info block address now in es:di */

movw $0x4f01, %ax /* get mode info block */
int $0x10

pop %es

calll _C_LABEL(real_to_prot)
.code32

andl $0xffff,%eax

pop %edi
pop %esi
popl %edx
popl %ecx
popl %ebx
popl %ebp
ret

/*
* Function 02h - Set VBE Mode
*
* int biosvbe_set_mode(int mode)
* return: VBE call status
*/
ENTRY(biosvbe_set_mode)
pushl %ebp
movl %esp,%ebp
pushl %ebx
pushl %ecx
pushl %edx
push %esi
push %edi

movl 8(%ebp), %ebx /* mode number */
orl $0x4000, %ebx

call _C_LABEL(prot_to_real)
.code16

movw $0x4f02, %ax /* set mode */
int $0x10

calll _C_LABEL(real_to_prot)
.code32

andl $0xffff,%eax

pop %edi
pop %esi
popl %edx
popl %ecx
popl %ebx
popl %ebp
ret

/*
* Function 08h - Set/Get DAC Palette Format
*
* int biosvbe_palette_format(int format)
* return: VBE call status
*/
ENTRY(biosvbe_palette_format)
pushl %ebp
movl %esp,%ebp
pushl %ebx
pushl %ecx
pushl %edx
push %esi
push %edi

movl 8(%ebp), %ebx /* mode number */

call _C_LABEL(prot_to_real)
.code16

movw $0x4f08, %ax /* get/set palette format */
int $0x10

calll _C_LABEL(real_to_prot)
.code32

andl $0xffff,%eax

pop %edi
pop %esi
popl %edx
popl %ecx
popl %ebx
popl %ebp
ret

/*
* Function 09h - Set/Get Palette Data
*
* int biosvbe_palette_data(int mode, int reg, struct paletteentry *)
* return: VBE call status
*/
ENTRY(biosvbe_palette_data)
pushl %ebp
movl %esp,%ebp
pushl %ebx
pushl %ecx
pushl %edx
push %esi
push %edi

movl 8(%ebp), %ebx /* mode number */
movl 12(%ebp), %edx /* register */
movl 16(%ebp), %edi /* palette entry address */
movl $1, %ecx /* # palette entries to update */

call _C_LABEL(prot_to_real)
.code16

push %es

push %di
shrl $4, %edi
mov %ds, %ax
add %di, %ax
mov %ax, %es
pop %di
and $0xf, %di /* palette entry address now in es:di */

movw $0x4f09, %ax /* get/set palette entry */
int $0x10

pop %es

calll _C_LABEL(real_to_prot)
.code32

andl $0xffff,%eax

pop %edi
pop %esi
popl %edx
popl %ecx
popl %ebx
popl %ebp
ret

/*
* Function 15h BL=00h - Report VBE/DDC Capabilities
*
* int biosvbe_ddc_caps(void)
* return: VBE/DDC capabilities
*/
ENTRY(biosvbe_ddc_caps)
pushl %ebp
movl %esp,%ebp
pushl %ebx
pushl %ecx
pushl %edx
push %esi
push %edi

call _C_LABEL(prot_to_real)
.code16

pushw %es

xorw %di, %di
movw %di, %es /* es:di == 0:0 */

movw $0x4f15, %ax /* display identification extensions */
mov $0x00, %bx /* report DDC capabilities */
mov $0x00, %cx /* controller unit number (00h = primary) */
int $0x10

popw %es

calll _C_LABEL(real_to_prot)
.code32

movl %eax,%ecx
movl $0x0000,%eax
andl $0xffff,%ecx
cmpl $0x004f,%ecx
jne 1f
andl $0xffff,%ebx
movl %ebx,%eax
1:

pop %edi
pop %esi
popl %edx
popl %ecx
popl %ebx
popl %ebp
ret

/*
* Function 15h BL=01h - Read EDID
*
* int biosvbe_ddc_read_edid(int blockno, void *buf)
* return: VBE call status
*/
ENTRY(biosvbe_ddc_read_edid)
pushl %ebp
movl %esp,%ebp
pushl %ebx
pushl %ecx
pushl %edx
push %esi
push %edi

movl 8(%ebp), %edx /* EDID block number */
movl 12(%ebp), %edi /* EDID block address */

call _C_LABEL(prot_to_real)
.code16

push %es

push %di
shrl $4, %edi
mov %ds, %ax
add %di, %ax
mov %ax, %es
pop %di
and $0xf, %di /* EDID block address now in es:di */

movw $0x4f15, %ax /* display identification extensions */
mov $0x01, %bx /* read EDID */
mov $0x00, %cx /* controller unit number (00h = primary) */
int $0x10

pop %es

calll _C_LABEL(real_to_prot)
.code32

andl $0xffff,%eax

pop %edi
pop %esi
popl %edx
popl %ecx
popl %ebx
popl %ebp
ret