fdsub.S revision 1.2 1 1.2 isaki /* $NetBSD: fdsub.S,v 1.2 2024/01/07 07:58:34 isaki Exp $ */
2 1.1 minoura
3 1.1 minoura /*
4 1.1 minoura * Copyright (c) 2001 MINOURA Makoto.
5 1.1 minoura * All rights reserved.
6 1.1 minoura *
7 1.1 minoura * Redistribution and use in source and binary forms, with or without
8 1.1 minoura * modification, are permitted provided that the following conditions
9 1.1 minoura * are met:
10 1.1 minoura * 1. Redistributions of source code must retain the above copyright
11 1.1 minoura * notice, this list of conditions and the following disclaimer.
12 1.1 minoura * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 minoura * notice, this list of conditions and the following disclaimer in the
14 1.1 minoura * documentation and/or other materials provided with the distribution.
15 1.1 minoura *
16 1.1 minoura * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 minoura * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 minoura * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 minoura * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 minoura * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 1.1 minoura * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 1.1 minoura * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 1.1 minoura * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 1.1 minoura * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 1.1 minoura * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 1.1 minoura */
27 1.1 minoura
28 1.1 minoura #include <machine/asm.h>
29 1.1 minoura #include "iocscall.h"
30 1.1 minoura
31 1.1 minoura /*
32 1.1 minoura * int fd_check_fmt(drive, head, minmax)
33 1.1 minoura * int drive; (0-3)
34 1.1 minoura * int head; (0-1)
35 1.1 minoura * struct fdfmt *minmax; (results are stored)
36 1.2 isaki * return value: 0 on success, or negative
37 1.1 minoura */
38 1.1 minoura
39 1.1 minoura .text
40 1.1 minoura ENTRY_NOPROFILE(fd_check_format)
41 1.1 minoura || movl %sp@(4),%d1
42 1.1 minoura || andil #3,%d1
43 1.1 minoura || orib #0x90,%d1
44 1.1 minoura || lslw #8,%d1
45 1.1 minoura || movql #0,%d2
46 1.1 minoura || IOCS(__B_DRVCHK)
47 1.1 minoura || btst.b #1,%d0
48 1.1 minoura || beq fail
49 1.1 minoura || IOCS(__B_RECALI)
50 1.1 minoura
51 1.1 minoura moveml %sp@(4),%d0-%d1
52 1.1 minoura andil #1,%d1
53 1.1 minoura andil #3,%d0
54 1.1 minoura lslw #2,%d1
55 1.1 minoura orw %d1,%d0
56 1.1 minoura jbsr check_fd_format
57 1.1 minoura
58 1.1 minoura tstl %d1
59 1.1 minoura beq fail1
60 1.1 minoura
61 1.1 minoura moval %sp@(12),%a0
62 1.1 minoura moveml %d0-%d1,%a0@
63 1.1 minoura
64 1.1 minoura movl #0,%d0
65 1.1 minoura rts
66 1.1 minoura
67 1.1 minoura ||fail:
68 1.1 minoura || movl #-6,%d0
69 1.1 minoura || rts
70 1.1 minoura fail1:
71 1.1 minoura movl #-5,%d0
72 1.1 minoura
73 1.1 minoura #define BOOT_ERROR(a) movl #0,%d1; \
74 1.1 minoura rts
75 1.1 minoura
76 1.1 minoura #include "chkfmt.s"
77