Home | History | Annotate | Line # | Download | only in lib
message32.S revision 1.1
      1  1.1  dsl /*	$NetBSD: message32.S,v 1.1 2009/11/19 22:13:17 dsl Exp $	*/
      2  1.1  dsl 
      3  1.1  dsl /*-
      4  1.1  dsl  * Copyright (c) 2003 The NetBSD Foundation, Inc.
      5  1.1  dsl  * All rights reserved.
      6  1.1  dsl  *
      7  1.1  dsl  * This code is derived from software contributed to The NetBSD Foundation
      8  1.1  dsl  * by David Laight.
      9  1.1  dsl  *
     10  1.1  dsl  * Redistribution and use in source and binary forms, with or without
     11  1.1  dsl  * modification, are permitted provided that the following conditions
     12  1.1  dsl  * are met:
     13  1.1  dsl  * 1. Redistributions of source code must retain the above copyright
     14  1.1  dsl  *    notice, this list of conditions and the following disclaimer.
     15  1.1  dsl  * 2. Redistributions in binary form must reproduce the above copyright
     16  1.1  dsl  *    notice, this list of conditions and the following disclaimer in the
     17  1.1  dsl  *    documentation and/or other materials provided with the distribution.
     18  1.1  dsl  *
     19  1.1  dsl  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  1.1  dsl  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  1.1  dsl  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  1.1  dsl  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  1.1  dsl  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  1.1  dsl  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  1.1  dsl  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  1.1  dsl  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  1.1  dsl  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  1.1  dsl  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  1.1  dsl  * POSSIBILITY OF SUCH DAMAGE.
     30  1.1  dsl  */
     31  1.1  dsl 
     32  1.1  dsl #include <machine/asm.h>
     33  1.1  dsl 
     34  1.1  dsl /*
     35  1.1  dsl  * Output messages directly to serial port from 32bit mode.
     36  1.1  dsl  * Useful for debugging when the real-prot is suspect.
     37  1.1  dsl  *
     38  1.1  dsl  * %ds:dump_eax_buff must be somewhere it is safe to write 12 bytes.
     39  1.1  dsl  */
     40  1.1  dsl 
     41  1.1  dsl #ifndef COM_PORT_VAL
     42  1.1  dsl #define COM_PORT_VAL $0x3f8	/* Standard address COM1 (dty0) */
     43  1.1  dsl #endif
     44  1.1  dsl 
     45  1.1  dsl 	.globl	message32
     46  1.1  dsl 	.code32
     47  1.1  dsl message32:
     48  1.1  dsl 	pusha
     49  1.1  dsl message32_1:
     50  1.1  dsl 	lodsb
     51  1.1  dsl 2:
     52  1.1  dsl 	mov     COM_PORT_VAL, %dx
     53  1.1  dsl 	outb    %al, %dx
     54  1.1  dsl 	add     $5, %dl
     55  1.1  dsl 3:      inb     %dx
     56  1.1  dsl 	test    $0x40, %al
     57  1.1  dsl 	jz      3b
     58  1.1  dsl 
     59  1.1  dsl 	lodsb
     60  1.1  dsl 	test    %al, %al
     61  1.1  dsl 	jnz     2b
     62  1.1  dsl 	popa
     63  1.1  dsl 	ret
     64  1.1  dsl 
     65  1.1  dsl 	.globl	dump_eax32
     66  1.1  dsl dump_eax32:
     67  1.1  dsl 	pusha
     68  1.1  dsl 	movl	$dump_eax_buff, %esi
     69  1.1  dsl 	mov	%esi, %edi
     70  1.1  dsl 	push	$8
     71  1.1  dsl 	pop	%ecx
     72  1.1  dsl 1:	roll	$4, %eax
     73  1.1  dsl 	push	%eax
     74  1.1  dsl 	andb	$0x0f, %al
     75  1.1  dsl 	addb	$0x30, %al			/* 30..3f - clear AF */
     76  1.1  dsl #if 1 /* 5 bytes to generate real hex... */
     77  1.1  dsl 	daa					/* 30..39, 40..45 */
     78  1.1  dsl 	addb	$0xc0, %al			/* f0..f9, 00..05 */
     79  1.1  dsl 	adcb	$0x40, %al			/* 30..39, 41..46 */
     80  1.1  dsl #endif
     81  1.1  dsl 	movb	%al,(%edi)
     82  1.1  dsl 	inc	%edi
     83  1.1  dsl 	pop	%eax
     84  1.1  dsl 	loop	1b
     85  1.1  dsl 	push	$0x20				/* space + 3 NULs */
     86  1.1  dsl 	pop	(%edi)
     87  1.1  dsl 	jmp	message32_1
     88