src/promemul/yamon.c

/*
 *  Copyright (C) 2005-2006  Anders Gavare.  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. The name of the author may not be used to endorse or promote products
 *     derived from this software without specific prior written permission.
 *
 *  THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 AUTHOR 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.
 *
 *
 *  $Id: yamon.c,v 1.5 2006/07/16 13:51:55 debug Exp $
 *
 *  YAMON emulation. (Very basic, only what is needed to get NetBSD booting.)
 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/types.h>

#include "console.h"
#include "cpu.h"
#include "cpu_mips.h"
#include "machine.h"
#include "memory.h"
#include "misc.h"

#ifdef ENABLE_MIPS

#include "yamon.h"


/*
 *  yamon_emul():
 *
 *  YAMON emulation (for evbmips).
 */
int yamon_emul(struct cpu *cpu)
{
        uint32_t ofs = (cpu->pc & 0xff) + YAMON_FUNCTION_BASE;
        uint8_t ch;
        int n;

        switch (ofs) {

        case YAMON_PRINT_COUNT_OFS:
                /*
                 *  print count:
                 *      a1 = string
                 *      a2 = count
                 */
                n = 0;
                while (n < (int32_t)cpu->cd.mips.gpr[MIPS_GPR_A2]) {
                        cpu->memory_rw(cpu, cpu->mem, (int32_t)cpu->cd.mips.gpr
                            [MIPS_GPR_A1] + n, &ch, sizeof(ch), MEM_READ,
                            CACHE_DATA | NO_EXCEPTIONS);
                        console_putchar(cpu->machine->main_console_handle, ch);
                        n++;
                }
                break;

        case YAMON_EXIT_OFS:
                /*
                 *  exit
                 */
                debug("[ yamon_emul(): exit ]\n");
                cpu->running = 0;
                break;

        /*  YAMON_FLUSH_CACHE_OFS: TODO  */
        /*  YAMON_PRINT_OFS: TODO  */
        /*  YAMON_REG_CPU_ISR_OFS: TODO  */
        /*  YAMON_DEREG_CPU_ISR_OFS: TODO  */
        /*  YAMON_REG_IC_ISR_OFS: TODO  */
        /*  YAMON_DEREG_IC_ISR_OFS: TODO  */
        /*  YAMON_REG_ESR_OFS: TODO  */
        /*  YAMON_DEREG_ESR_OFS: TODO  */

        case YAMON_GETCHAR_OFS:
                n = console_readchar(cpu->machine->main_console_handle);
                /*  Note: -1 (if no char was available) becomes 0xff:  */
                ch = n;
                cpu->memory_rw(cpu, cpu->mem, (int32_t)cpu->cd.mips.gpr[
                    MIPS_GPR_A1], &ch, sizeof(ch), MEM_WRITE,
                    CACHE_DATA | NO_EXCEPTIONS);
                break;

        case YAMON_SYSCON_READ_OFS:
                /*
                 *  syscon
                 */
                fatal("[ yamon_emul(): syscon: TODO ]\n");

                /*  TODO. For now, return some kind of "failure":  */
                cpu->cd.mips.gpr[MIPS_GPR_V0] = 1;
                break;

        default:cpu_register_dump(cpu->machine, cpu, 1, 0);
                printf("\n");
                fatal("[ yamon_emul(): unimplemented yamon function 0x%"
                    PRIx32" ]\n", ofs);
                cpu->running = 0;
                cpu->dead = 1;
        }

        return 1;
}

#endif  /*  ENABLE_MIPS  */
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	28	* $Id: yamon.c,v 1.5 2006/07/16 13:51:55 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			cpu->dead = 1;
121			}
122
123			return 1;
124			}
125
126			#endif /* ENABLE_MIPS */