Home | History | Annotate | Line # | Download | only in nbfs
rmheader.S revision 1.3
      1 /*	$NetBSD: rmheader.S,v 1.3 2006/07/13 15:51:54 bjh21 Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2001, 2006 Ben Harris
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  * 3. The name of the author may not be used to endorse or promote products
     16  *    derived from this software without specific prior written permission.
     17  *
     18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     20  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     21  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     22  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     23  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     24  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     25  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     26  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     27  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     28  */
     29 
     30 /*
     31  * Relocatable module header for NBFS.
     32  */
     33 
     34 #include <arm/armreg.h>
     35 #include <riscoscalls.h>
     36 
     37 #include "nbfs.h"
     38 
     39 rmbase:
     40 	.word	0			/* Start code */
     41 	.word	rminit - rmbase		/* Initialisation code */
     42 	.word	rmfinal - rmbase	/* Finalisation code */
     43 	.word	0			/* Service call handler */
     44 	.word	rmtitle - rmbase	/* Title string */
     45 	.word	rmhelp - rmbase		/* Help string */
     46 	.word	rmcmdtbl - rmbase	/* Help and command keyword table */
     47 	.word	0			/* SWI chunk base number */
     48 	.word	0			/* SWI handler code offset */
     49 	.word	0			/* SWI decoding table offset */
     50 	.word	0			/* SWI decoding code offset */
     51 	.word	0			/* Messages filename offset */
     52 	.word	flags - rmbase		/* Module flags extension offset */
     53 
     54 fsib:	/* Filing system information block */
     55 	.word	rmtitle - rmbase	/* Filing system name */
     56 	.word	rmtitle - rmbase	/* Filing system boot text */
     57 	.word	fsentry_open - rmbase
     58 	.word	fsentry_getbytes - rmbase
     59 	.word	fsentry_putbytes - rmbase
     60 	.word	fsentry_args - rmbase
     61 	.word	fsentry_close - rmbase
     62 	.word	fsentry_file - rmbase
     63 	.word	fileswitch_SUPPORTS_SPECIAL | fileswitch_READ_ONLY | NBFS_FSNUM
     64 	.word	fsentry_func - rmbase
     65 	.word	0			/* FSEntry_GBPB */
     66 	.word	0			/* Extra information word */
     67 
     68 rmtitle:
     69 	.asciz	"NBFS"
     70 	.align
     71 flags:
     72 	.word	0			/* not 32 bit compatible */
     73 
     74 rminit:
     75 	/*
     76 	 * Module initialisation code
     77 	 *
     78 	 * On entry:
     79 	 * r10 = pointer to environment string
     80 	 * r11 = I/O base or instantiation number
     81 	 * r12 = pointer to private word
     82 	 * r14 = return address
     83 	 */
     84 	stmfd	r13!, {r14}
     85 	ldr	r1, Loldbase		/* Get old base address */
     86 	adr	r2, rmbase		/* Get new base address */
     87 	str	r2, Loldbase		/* New is the new old */
     88 	ldr	r0, L_DYNAMIC		/* Pointer to the dynamic table */
     89 	add	r0, r0, r2		/* ... relocated appropriately */
     90 	bl	relocate_self		/* Call the relocation code */
     91 	cmp	r0, #0
     92 	bne	Lerror
     93 	mov	r0, #OSFSControl_AddFS
     94 	adr	r1, rmbase
     95 	mov	r2, #(fsib - rmbase)
     96 	mov	r3, #0
     97 	swi	XOS_FSControl
     98 	ldmfd	r13!, {pc}		/* If that failed, so do we */
     99 
    100 rmfinal:
    101 	stmfd	r13!, {r14}
    102 	mov	r0, #OSFSControl_RemoveFS
    103 	adr	r1, rmtitle
    104 	swi	XOS_FSControl
    105 	cmp	r0, r0			/* Clear V flag */
    106 	ldmfd	r13!, {pc}
    107 
    108 Lerror:
    109 	teq	pc, pc			/* In 26-bit mode? */
    110 	ldmneia	r13!, {r14}		/* If so, load up return address */
    111 	orrnes	pc, r14, #R15_FLAG_V	/* and return setting V flag */
    112 	mrs	r14, cpsr		/* Otherwise get cpsr */
    113 	orr	r14, r14, #PSR_V_bit	/* set V flag */
    114 	msr	cpsr_c, r14		/* put it back */
    115 	ldmfd	r13!, {pc}		/* and return */
    116 
    117 Loldbase:
    118 	.word	0
    119 L_DYNAMIC:
    120 	.word	_DYNAMIC - rmbase
    121 
    122 
    123 fsentry_open:
    124 	stmfd	r13!, {r0-r7, r14}
    125 	mov	r0, r13
    126 	adr	r14, fsentry_ret
    127 	b	nbfs_open
    128 
    129 fsentry_getbytes:
    130 	stmfd	r13!, {r0-r7, r14}
    131 	mov	r0, r13
    132 	adr	r14, fsentry_ret
    133 	b	nbfs_getbytes
    134 
    135 fsentry_putbytes:
    136 	stmfd	r13!, {r0-r7, r14}
    137 	mov	r0, r13
    138 	adr	r14, fsentry_ret
    139 	b	nbfs_putbytes
    140 
    141 fsentry_args:
    142 	stmfd	r13!, {r0-r7, r14}
    143 	mov	r0, r13
    144 	adr	r14, fsentry_ret
    145 	b	nbfs_args
    146 
    147 fsentry_close:
    148 	stmfd	r13!, {r0-r7, r14}
    149 	mov	r0, r13
    150 	adr	r14, fsentry_ret
    151 	b	nbfs_close
    152 
    153 fsentry_file:
    154 	stmfd	r13!, {r0-r7, r14}
    155 	mov	r0, r13
    156 	adr	r14, fsentry_ret
    157 	b	nbfs_file
    158 
    159 fsentry_func:
    160 	stmfd	r13!, {r0-r7, r14}
    161 	mov	r0, r13
    162 	adr	r14, fsentry_ret
    163 	b	nbfs_func
    164 
    165 fsentry_ret:
    166 	cmp	r0, #0
    167 	ldmeqfd	r13!, {r0-r7, pc}
    168 	add	r13, r13, #4
    169 	ldmfd	r13!, {r1-r7}
    170 	b	Lerror
    171 
    172 rmcmdtbl:
    173 	.asciz	"NBFS"			/* Command text */
    174 	.align
    175 	.word	rmcmd_nbfs - rmbase	/* Command code */
    176 	.byte	0x00			/* Min 0 parameters */
    177 	.byte	0x00			/* No GSTransed parameters */
    178 	.byte	0x00			/* Max 0 parameters */
    179 	.byte	0x00			/* Normal command */
    180 	.word	rmcmd_nbfs_syntax - rmbase /* Syntax message */
    181 	.word	rmcmd_nbfs_help - rmbase /* Help message */
    182 
    183 	.byte	0			/* end of list */
    184 
    185 rmcmd_nbfs_syntax:
    186 	.asciz	"Syntax: NBFS"
    187 rmcmd_nbfs_help:
    188 	.asciz	"*NBFS selects NBFS as the current filing system."
    189 	.align
    190 
    191 rmcmd_nbfs:
    192 	/* We're called with r0 -> command tail. */
    193 	stmfd	r13!, {r14}
    194 	mov	r0, #OSFSControl_SelectFS
    195 	adr	r1, rmtitle
    196 	swi	XOS_FSControl
    197 	ldmfd	r13!, {pc}
    198