1 |
dpavlin |
14 |
/* |
2 |
dpavlin |
22 |
* Copyright (C) 2005-2006 Anders Gavare. All rights reserved. |
3 |
dpavlin |
14 |
* |
4 |
|
|
* Redistribution and use in source and binary forms, with or without |
5 |
|
|
* modification, are permitted provided that the following conditions are met: |
6 |
|
|
* |
7 |
|
|
* 1. Redistributions of source code must retain the above copyright |
8 |
|
|
* notice, this list of conditions and the following disclaimer. |
9 |
|
|
* 2. Redistributions in binary form must reproduce the above copyright |
10 |
|
|
* notice, this list of conditions and the following disclaimer in the |
11 |
|
|
* documentation and/or other materials provided with the distribution. |
12 |
|
|
* 3. The name of the author may not be used to endorse or promote products |
13 |
|
|
* derived from this software without specific prior written permission. |
14 |
|
|
* |
15 |
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND |
16 |
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
17 |
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
18 |
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE |
19 |
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
20 |
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS |
21 |
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) |
22 |
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
23 |
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY |
24 |
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF |
25 |
|
|
* SUCH DAMAGE. |
26 |
|
|
* |
27 |
|
|
* |
28 |
dpavlin |
30 |
* $Id: yamon.c,v 1.6 2006/07/26 23:21:48 debug Exp $ |
29 |
dpavlin |
14 |
* |
30 |
dpavlin |
28 |
* YAMON emulation. (Very basic, only what is needed to get NetBSD booting.) |
31 |
dpavlin |
14 |
*/ |
32 |
|
|
|
33 |
|
|
#include <stdio.h> |
34 |
|
|
#include <stdlib.h> |
35 |
|
|
#include <string.h> |
36 |
|
|
#include <sys/types.h> |
37 |
|
|
|
38 |
|
|
#include "console.h" |
39 |
|
|
#include "cpu.h" |
40 |
|
|
#include "cpu_mips.h" |
41 |
|
|
#include "machine.h" |
42 |
|
|
#include "memory.h" |
43 |
|
|
#include "misc.h" |
44 |
|
|
|
45 |
|
|
#ifdef ENABLE_MIPS |
46 |
|
|
|
47 |
dpavlin |
28 |
#include "yamon.h" |
48 |
dpavlin |
14 |
|
49 |
|
|
|
50 |
|
|
/* |
51 |
|
|
* yamon_emul(): |
52 |
|
|
* |
53 |
|
|
* YAMON emulation (for evbmips). |
54 |
|
|
*/ |
55 |
|
|
int yamon_emul(struct cpu *cpu) |
56 |
|
|
{ |
57 |
dpavlin |
28 |
uint32_t ofs = (cpu->pc & 0xff) + YAMON_FUNCTION_BASE; |
58 |
|
|
uint8_t ch; |
59 |
dpavlin |
14 |
int n; |
60 |
|
|
|
61 |
|
|
switch (ofs) { |
62 |
dpavlin |
28 |
|
63 |
|
|
case YAMON_PRINT_COUNT_OFS: |
64 |
|
|
/* |
65 |
|
|
* print count: |
66 |
|
|
* a1 = string |
67 |
|
|
* a2 = count |
68 |
|
|
*/ |
69 |
dpavlin |
14 |
n = 0; |
70 |
dpavlin |
28 |
while (n < (int32_t)cpu->cd.mips.gpr[MIPS_GPR_A2]) { |
71 |
|
|
cpu->memory_rw(cpu, cpu->mem, (int32_t)cpu->cd.mips.gpr |
72 |
|
|
[MIPS_GPR_A1] + n, &ch, sizeof(ch), MEM_READ, |
73 |
|
|
CACHE_DATA | NO_EXCEPTIONS); |
74 |
|
|
console_putchar(cpu->machine->main_console_handle, ch); |
75 |
dpavlin |
14 |
n++; |
76 |
|
|
} |
77 |
|
|
break; |
78 |
dpavlin |
28 |
|
79 |
|
|
case YAMON_EXIT_OFS: |
80 |
|
|
/* |
81 |
|
|
* exit |
82 |
|
|
*/ |
83 |
|
|
debug("[ yamon_emul(): exit ]\n"); |
84 |
dpavlin |
14 |
cpu->running = 0; |
85 |
|
|
break; |
86 |
dpavlin |
28 |
|
87 |
|
|
/* YAMON_FLUSH_CACHE_OFS: TODO */ |
88 |
|
|
/* YAMON_PRINT_OFS: TODO */ |
89 |
|
|
/* YAMON_REG_CPU_ISR_OFS: TODO */ |
90 |
|
|
/* YAMON_DEREG_CPU_ISR_OFS: TODO */ |
91 |
|
|
/* YAMON_REG_IC_ISR_OFS: TODO */ |
92 |
|
|
/* YAMON_DEREG_IC_ISR_OFS: TODO */ |
93 |
|
|
/* YAMON_REG_ESR_OFS: TODO */ |
94 |
|
|
/* YAMON_DEREG_ESR_OFS: TODO */ |
95 |
|
|
|
96 |
|
|
case YAMON_GETCHAR_OFS: |
97 |
|
|
n = console_readchar(cpu->machine->main_console_handle); |
98 |
|
|
/* Note: -1 (if no char was available) becomes 0xff: */ |
99 |
|
|
ch = n; |
100 |
|
|
cpu->memory_rw(cpu, cpu->mem, (int32_t)cpu->cd.mips.gpr[ |
101 |
|
|
MIPS_GPR_A1], &ch, sizeof(ch), MEM_WRITE, |
102 |
|
|
CACHE_DATA | NO_EXCEPTIONS); |
103 |
|
|
break; |
104 |
|
|
|
105 |
|
|
case YAMON_SYSCON_READ_OFS: |
106 |
|
|
/* |
107 |
|
|
* syscon |
108 |
|
|
*/ |
109 |
dpavlin |
14 |
fatal("[ yamon_emul(): syscon: TODO ]\n"); |
110 |
dpavlin |
28 |
|
111 |
dpavlin |
14 |
/* TODO. For now, return some kind of "failure": */ |
112 |
|
|
cpu->cd.mips.gpr[MIPS_GPR_V0] = 1; |
113 |
|
|
break; |
114 |
dpavlin |
28 |
|
115 |
dpavlin |
14 |
default:cpu_register_dump(cpu->machine, cpu, 1, 0); |
116 |
|
|
printf("\n"); |
117 |
dpavlin |
28 |
fatal("[ yamon_emul(): unimplemented yamon function 0x%" |
118 |
|
|
PRIx32" ]\n", ofs); |
119 |
dpavlin |
14 |
cpu->running = 0; |
120 |
|
|
} |
121 |
|
|
|
122 |
|
|
return 1; |
123 |
|
|
} |
124 |
|
|
|
125 |
|
|
#endif /* ENABLE_MIPS */ |