123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343 |
- /* This file is part of the program psim.
- Copyright (C) 1994-1997, Andrew Cagney <cagney@highland.com.au>
- This program is free software; you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation; either version 3 of the License, or
- (at your option) any later version.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
- You should have received a copy of the GNU General Public License
- along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
- #ifndef _EMUL_GENERIC_C_
- #define _EMUL_GENERIC_C_
- #include "emul_generic.h"
- #ifndef STATIC_INLINE_EMUL_GENERIC
- #define STATIC_INLINE_EMUL_GENERIC STATIC_INLINE
- #endif
- STATIC_INLINE_EMUL_GENERIC void
- emul_syscall_enter(emul_syscall *emul,
- int call,
- int arg0,
- cpu *processor,
- unsigned_word cia)
- {
- printf_filtered("%d:0x%lx:%s(",
- cpu_nr(processor) + 1,
- (long)cia,
- emul->syscall_descriptor[call].name);
- }
- STATIC_INLINE_EMUL_GENERIC void
- emul_syscall_exit(emul_syscall *emul,
- int call,
- int arg0,
- cpu *processor,
- unsigned_word cia)
- {
- int status = cpu_registers(processor)->gpr[3];
- int error = cpu_registers(processor)->gpr[0];
- printf_filtered(")=%d", status);
- if (error > 0 && error < emul->nr_error_names)
- printf_filtered("[%s]", emul->error_names[error]);
- printf_filtered("\n");
- }
- INLINE_EMUL_GENERIC unsigned64
- emul_read_gpr64(cpu *processor,
- int g)
- {
- unsigned32 hi;
- unsigned32 lo;
- if (CURRENT_TARGET_BYTE_ORDER == BIG_ENDIAN) {
- hi = cpu_registers(processor)->gpr[g];
- lo = cpu_registers(processor)->gpr[g+1];
- }
- else {
- lo = cpu_registers(processor)->gpr[g];
- hi = cpu_registers(processor)->gpr[g+1];
- }
- return (INSERTED64(hi, 0, 31) | INSERTED64(lo, 32, 63));
- }
- INLINE_EMUL_GENERIC void
- emul_write_gpr64(cpu *processor,
- int g,
- unsigned64 val)
- {
- unsigned32 hi = EXTRACTED64(val, 0, 31);
- unsigned32 lo = EXTRACTED64(val, 32, 63);
- if (CURRENT_TARGET_BYTE_ORDER == BIG_ENDIAN) {
- cpu_registers(processor)->gpr[g] = hi;
- cpu_registers(processor)->gpr[g+1] = lo;
- }
- else {
- cpu_registers(processor)->gpr[g] = lo;
- cpu_registers(processor)->gpr[g+1] = hi;
- }
- }
- INLINE_EMUL_GENERIC char *
- emul_read_string(char *dest,
- unsigned_word addr,
- unsigned nr_bytes,
- cpu *processor,
- unsigned_word cia)
- {
- unsigned nr_moved = 0;
- if (addr == 0)
- return NULL;
- while (1) {
- dest[nr_moved] = vm_data_map_read_1(cpu_data_map(processor),
- addr + nr_moved,
- processor, cia);
- if (dest[nr_moved] == '\0' || nr_moved >= nr_bytes)
- break;
- nr_moved++;
- }
- dest[nr_moved] = '\0';
- return dest;
- }
- INLINE_EMUL_GENERIC void
- emul_write_status(cpu *processor,
- int status,
- int errno)
- {
- if (status == -1 && errno != 0) {
- cpu_registers(processor)->gpr[3] = errno;
- CR_SET(0, cr_i_summary_overflow);
- }
- else {
- cpu_registers(processor)->gpr[3] = status;
- CR_SET(0, 0);
- }
- }
- INLINE_EMUL_GENERIC void
- emul_write2_status(cpu *processor,
- int status1,
- int status2,
- int errno)
- {
- if (status1 == -1 && errno != 0) {
- cpu_registers(processor)->gpr[3] = errno;
- CR_SET(0, cr_i_summary_overflow);
- }
- else {
- cpu_registers(processor)->gpr[3] = status1;
- cpu_registers(processor)->gpr[4] = status2;
- CR_SET(0, 0);
- }
- }
- INLINE_EMUL_GENERIC unsigned_word
- emul_read_word(unsigned_word addr,
- cpu *processor,
- unsigned_word cia)
- {
- return vm_data_map_read_word(cpu_data_map(processor),
- addr,
- processor, cia);
- }
- INLINE_EMUL_GENERIC void
- emul_write_word(unsigned_word addr,
- unsigned_word buf,
- cpu *processor,
- unsigned_word cia)
- {
- vm_data_map_write_word(cpu_data_map(processor),
- addr,
- buf,
- processor, cia);
- }
- INLINE_EMUL_GENERIC void
- emul_write_buffer(const void *source,
- unsigned_word addr,
- unsigned nr_bytes,
- cpu *processor,
- unsigned_word cia)
- {
- int nr_moved;
- for (nr_moved = 0; nr_moved < nr_bytes; nr_moved++) {
- vm_data_map_write_1(cpu_data_map(processor),
- addr + nr_moved,
- ((const char*)source)[nr_moved],
- processor, cia);
- }
- }
- INLINE_EMUL_GENERIC void
- emul_read_buffer(void *dest,
- unsigned_word addr,
- unsigned nr_bytes,
- cpu *processor,
- unsigned_word cia)
- {
- int nr_moved;
- for (nr_moved = 0; nr_moved < nr_bytes; nr_moved++) {
- ((char*)dest)[nr_moved] = vm_data_map_read_1(cpu_data_map(processor),
- addr + nr_moved,
- processor, cia);
- }
- }
- INLINE_EMUL_GENERIC void
- emul_do_system_call(os_emul_data *emul_data,
- emul_syscall *emul,
- unsigned call,
- const int arg0,
- cpu *processor,
- unsigned_word cia)
- {
- emul_syscall_handler *handler = NULL;
- if (call >= emul->nr_system_calls)
- error("do_call() os_emul call %d out-of-range\n", call);
- handler = emul->syscall_descriptor[call].handler;
- if (handler == NULL) {
- if (emul->syscall_descriptor[call].name) {
- error("do_call() unimplemented call %s\n", emul->syscall_descriptor[call].name);
- } else {
- error("do_call() unimplemented call %d\n", call);
- }
- }
- if (WITH_TRACE && ppc_trace[trace_os_emul])
- emul_syscall_enter(emul, call, arg0, processor, cia);
- cpu_registers(processor)->gpr[0] = 0; /* default success */
- handler(emul_data, call, arg0, processor, cia);
- if (WITH_TRACE && ppc_trace[trace_os_emul])
- emul_syscall_exit(emul, call, arg0, processor, cia);
- }
- /* default size for the first bank of memory */
- #ifndef OEA_MEMORY_SIZE
- #define OEA_MEMORY_SIZE 0x100000
- #endif
- /* Add options to the device tree */
- INLINE_EMUL_GENERIC void
- emul_add_tree_options(device *tree,
- bfd *image,
- const char *emul,
- const char *env,
- int oea_interrupt_prefix)
- {
- int little_endian = 0;
- /* sort out little endian */
- if (tree_find_property(tree, "/options/little-endian?"))
- little_endian = tree_find_boolean_property(tree, "/options/little-endian?");
- else {
- #ifdef bfd_little_endian /* new bfd */
- little_endian = (image != NULL && bfd_little_endian(image));
- #else
- little_endian = (image != NULL &&
- !image->xvec->byteorder_big_p);
- #endif
- tree_parse(tree, "/options/little-endian? %s",
- little_endian ? "true" : "false");
- }
- /* misc other stuff */
- tree_parse(tree, "/openprom/options/oea-memory-size 0x%x",
- OEA_MEMORY_SIZE);
- tree_parse(tree, "/openprom/options/oea-interrupt-prefix %d",
- oea_interrupt_prefix);
- tree_parse(tree, "/openprom/options/smp 1");
- tree_parse(tree, "/openprom/options/env %s", env);
- tree_parse(tree, "/openprom/options/os-emul %s", emul);
- tree_parse(tree, "/openprom/options/strict-alignment? %s",
- (WITH_ALIGNMENT == STRICT_ALIGNMENT)
- ? "true" : "false");
- tree_parse(tree, "/openprom/options/floating-point? %s",
- WITH_FLOATING_POINT ? "true" : "false");
- tree_parse(tree, "/openprom/options/use-stdio? %s",
- ((WITH_STDIO == DO_USE_STDIO
- || WITH_STDIO == 0)
- ? "true" : "false"));
- tree_parse(tree, "/openprom/options/model \"%s",
- model_name[WITH_DEFAULT_MODEL]);
- tree_parse(tree, "/openprom/options/model-issue %d",
- MODEL_ISSUE_IGNORE);
- /* useful options */
- }
- INLINE_EMUL_GENERIC void
- emul_add_tree_hardware(device *root)
- {
- int i;
- int nr_cpus = tree_find_integer_property(root, "/openprom/options/smp");
- /* sanity check the number of processors */
- if (nr_cpus > MAX_NR_PROCESSORS)
- error("Specified number of processors (%d) exceeds the number configured (%d).\n",
- nr_cpus, MAX_NR_PROCESSORS);
- /* set the number of address cells (1 or 2) */
- tree_parse(root, "#address-cells %d", WITH_TARGET_WORD_BITSIZE / 32);
- /* add some memory */
- if (tree_find_device(root, "/memory") == NULL) {
- unsigned_word memory_size =
- tree_find_integer_property(root, "/openprom/options/oea-memory-size");
- const unsigned_word avail_start = 0x3000;
- tree_parse(root, "/memory@0/reg 0x0 0x%lx",
- (unsigned long)memory_size);
- /* reserve the first 0x3000 for the PowerPC interrupt table */
- tree_parse(root, "/memory@0/available 0x%lx 0x%lx",
- (unsigned long)avail_start,
- (unsigned long)memory_size - avail_start);
- }
- /* our processors */
- for (i = 0; i < nr_cpus; i++) {
- tree_parse(root, "/cpus/cpu@%d/cpu-nr %d", i, i);
- }
- /* the debugging pal - hide it in the openprom and don't attach it
- to any bus */
- tree_parse(root, "/openprom/pal");
- /* chosen etc */
- tree_parse(root, "/chosen/stdin */openprom/pal");
- tree_parse(root, "/chosen/stdout !/chosen/stdin");
- tree_parse(root, "/chosen/memory */memory");
- }
- #endif /* _EMUL_GENERIC_C_ */
|