NetBSD/sys/arch/arm32/vidc/console/vidc_mc.S

217 lines
4.9 KiB
ArmAsm

/* $NetBSD: vidc_mc.S,v 1.2 1996/02/02 02:36:04 mycroft Exp $ */
/*
* Copyright (c) 1994-1995 Melvyn Tang-Richardson
* Copyright (c) 1994-1995 RiscBSD kernel team
* 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.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the RiscBSD kernel team
* 4. The name of the company nor the name of the author may be used to
* endorse or promote products derived from this software without specific
* prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE RISCBSD TEAM ``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 AUTHORS 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.
*
* RiscBSD kernel project
*
* vidc_mc.S
*
* Console assembly functions
*
* Created : 17/09/94
* Last updated : 15/11/95
*
* $Id: vidc_mc.S,v 1.2 1996/02/02 02:36:04 mycroft Exp $
*/
#include "assym.h"
#include <machine/iomd.h>
lr .req r14
pc .req r15
sp .req r13
.text
.global _vidcconsole_loadtab
_vidcconsole_loadtab:
mov r0, r0
ldmia r0!, { r2 }
ldmia r0!, { r2-r3 }
ldmia r0!, { r2-r4 }
ldmia r0!, { r2-r5 }
ldmia r0!, { r2-r6 }
ldmia r0!, { r2-r7 }
ldmia r0!, { r2-r8 }
ldmia r0!, { r2-r9 }
ldmia r0!, { r2-r10 }
ldmia r0!, { r2-r11 }
ldmia r0!, { r2-r12 }
ldmia r0!, { r2-r12, r14 }
.global _vidcconsole_storetab
_vidcconsole_storetab:
mov r0, r0
stmia r0!, { r2 }
stmia r0!, { r2-r3 }
stmia r0!, { r2-r4 }
stmia r0!, { r2-r5 }
stmia r0!, { r2-r6 }
stmia r0!, { r2-r7 }
stmia r0!, { r2-r8 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r10 }
stmia r0!, { r2-r11 }
stmia r0!, { r2-r12 }
stmia r0!, { r2-r12, r14 }
.global _vidcconsole_pushtab
_vidcconsole_pushtab:
mov r0, r0
stmfd r13!, { r0-r3 }
stmfd r13!, { r0-r7 }
stmfd r13!, { r0-r11 }
stmfd r13!, { r0-r14 }
.global _vidcconsole_poptab
_vidcconsole_poptab:
mov r0, r0
ldmfd r13!, { r0-r3 }
ldmfd r13!, { r0-r7 }
ldmfd r13!, { r0-r11 }
ldmfd r13!, { r0-r14 }
.global _vidcconsole_enter
_vidcconsole_enter:
stmfd r13!, { r15 }
.global _vidcconsole_exit
_vidcconsole_exit:
stmfd r13!, { r15 }
.global _vidcconsolemc_render
/* On entry r0 = addr */
/* r1 = font */
/* r2 = col */
/* r3 = xres */
/* Optimise for 8x16 font */
/* At the moment */
_vidcconsolemc_render:
stmfd r13!, {r0-r9, lr}
/* Generate colour mask */
mov r9, r2, lsr #16
mov r4, r2, lsr #8
and r9, r9, #0xff
and r4, r4, #0xff
and r2, r2, #0xff
/* For each row (8 pixels) */
xloop:
ldrb r5, [r1], #1
mov r7, #0
mov r8, #0
/* This loop will get *SOOOO* much faster with */
/* the new algorithmn */
tst r5, #8
orrne r7, r2, r7, lsl #8
orreq r7, r4, r7, lsl #8
tst r5, #4
orrne r7, r2, r7, lsl #8
orreq r7, r4, r7, lsl #8
tst r5, #2
orrne r7, r2, r7, lsl #8
orreq r7, r4, r7, lsl #8
tst r5, #1
orrne r7, r2, r7, lsl #8
orreq r7, r4, r7, lsl #8
tst r5, #0x80
orrne r8, r2, r8, lsl #8
orreq r8, r4, r8, lsl #8
tst r5, #0x40
orrne r8, r2, r8, lsl #8
orreq r8, r4, r8, lsl #8
tst r5, #0x20
orrne r8, r2, r8, lsl #8
orreq r8, r4, r8, lsl #8
tst r5, #0x10
orrne r8, r2, r8, lsl #8
orreq r8, r4, r8, lsl #8
stmia r0, {r7, r8}
add r0, r0, r3
subs r9, r9, #1
bne xloop
ldmfd r13!, {r0-r9, pc}
.global _vidcconsolemc_cls
/* On entry r0 = start */
/* r1 = end */
/* r2 = col */
_vidcconsolemc_cls:
stmfd r13!, {r0-r9, lr}
mov r3, r2
mov r4, r2
mov r5, r2
mov r6, r2
mov r7, r2
mov r8, r2
mov r9, r2
loop:
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
stmia r0!, { r2-r9 }
cmp r0, r1
ble loop
ldmfd r13!, {r0-r9, pc}