1/*  This file is part of the program psim.
2
3    Copyright (C) 1994-1997, Andrew Cagney <cagney@highland.com.au>
4
5    This program is free software; you can redistribute it and/or modify
6    it under the terms of the GNU General Public License as published by
7    the Free Software Foundation; either version 2 of the License, or
8    (at your option) any later version.
9
10    This program is distributed in the hope that it will be useful,
11    but WITHOUT ANY WARRANTY; without even the implied warranty of
12    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13    GNU General Public License for more details.
14
15    You should have received a copy of the GNU General Public License
16    along with this program; if not, write to the Free Software
17    Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
18
19    */
20
21
22#ifndef _EMUL_GENERIC_C_
23#define _EMUL_GENERIC_C_
24
25#include "emul_generic.h"
26
27#ifndef STATIC_INLINE_EMUL_GENERIC
28#define STATIC_INLINE_EMUL_GENERIC STATIC_INLINE
29#endif
30
31
32STATIC_INLINE_EMUL_GENERIC void
33emul_syscall_enter(emul_syscall *emul,
34		   int call,
35		   int arg0,
36		   cpu *processor,
37		   unsigned_word cia)
38{
39  printf_filtered("%d:0x%lx:%s(",
40		  cpu_nr(processor) + 1,
41		  (long)cia,
42		  emul->syscall_descriptor[call].name);
43}
44
45
46STATIC_INLINE_EMUL_GENERIC void
47emul_syscall_exit(emul_syscall *emul,
48		  int call,
49		  int arg0,
50		  cpu *processor,
51		  unsigned_word cia)
52{
53  int status = cpu_registers(processor)->gpr[3];
54  int error = cpu_registers(processor)->gpr[0];
55  printf_filtered(")=%d", status);
56  if (error > 0 && error < emul->nr_error_names)
57    printf_filtered("[%s]", emul->error_names[error]);
58  printf_filtered("\n");
59}
60
61
62INLINE_EMUL_GENERIC unsigned64
63emul_read_gpr64(cpu *processor,
64		int g)
65{
66  unsigned32 hi;
67  unsigned32 lo;
68  if (CURRENT_TARGET_BYTE_ORDER == BIG_ENDIAN) {
69    hi = cpu_registers(processor)->gpr[g];
70    lo = cpu_registers(processor)->gpr[g+1];
71  }
72  else {
73    lo = cpu_registers(processor)->gpr[g];
74    hi = cpu_registers(processor)->gpr[g+1];
75  }
76  return (INSERTED64(hi, 0, 31) | INSERTED64(lo, 32, 63));
77}
78
79
80INLINE_EMUL_GENERIC void
81emul_write_gpr64(cpu *processor,
82		 int g,
83		 unsigned64 val)
84{
85  unsigned32 hi = EXTRACTED64(val, 0, 31);
86  unsigned32 lo = EXTRACTED64(val, 32, 63);
87  if (CURRENT_TARGET_BYTE_ORDER == BIG_ENDIAN) {
88    cpu_registers(processor)->gpr[g] = hi;
89    cpu_registers(processor)->gpr[g+1] = lo;
90  }
91  else {
92    cpu_registers(processor)->gpr[g] = lo;
93    cpu_registers(processor)->gpr[g+1] = hi;
94  }
95}
96
97
98INLINE_EMUL_GENERIC char *
99emul_read_string(char *dest,
100		 unsigned_word addr,
101		 unsigned nr_bytes,
102		 cpu *processor,
103		 unsigned_word cia)
104{
105  unsigned nr_moved = 0;
106  if (addr == 0)
107    return NULL;
108  while (1) {
109    dest[nr_moved] = vm_data_map_read_1(cpu_data_map(processor),
110					addr + nr_moved,
111					processor, cia);
112    if (dest[nr_moved] == '\0' || nr_moved >= nr_bytes)
113      break;
114    nr_moved++;
115  }
116  dest[nr_moved] = '\0';
117  return dest;
118}
119
120
121INLINE_EMUL_GENERIC void
122emul_write_status(cpu *processor,
123		  int status,
124		  int errno)
125{
126  if (status == -1 && errno != 0) {
127    cpu_registers(processor)->gpr[3] = errno;
128    CR_SET(0, cr_i_summary_overflow);
129  }
130  else {
131    cpu_registers(processor)->gpr[3] = status;
132    CR_SET(0, 0);
133  }
134}
135
136
137INLINE_EMUL_GENERIC void
138emul_write2_status(cpu *processor,
139		   int status1,
140		   int status2,
141		   int errno)
142{
143  if (status1 == -1 && errno != 0) {
144    cpu_registers(processor)->gpr[3] = errno;
145    CR_SET(0, cr_i_summary_overflow);
146  }
147  else {
148    cpu_registers(processor)->gpr[3] = status1;
149    cpu_registers(processor)->gpr[4] = status2;
150    CR_SET(0, 0);
151  }
152}
153
154
155INLINE_EMUL_GENERIC unsigned_word
156emul_read_word(unsigned_word addr,
157	       cpu *processor,
158	       unsigned_word cia)
159{
160  return vm_data_map_read_word(cpu_data_map(processor),
161			       addr,
162			       processor, cia);
163}
164
165
166INLINE_EMUL_GENERIC void
167emul_write_word(unsigned_word addr,
168		unsigned_word buf,
169		cpu *processor,
170		unsigned_word cia)
171{
172  vm_data_map_write_word(cpu_data_map(processor),
173			 addr,
174			 buf,
175			 processor, cia);
176}
177
178
179INLINE_EMUL_GENERIC void
180emul_write_buffer(const void *source,
181		  unsigned_word addr,
182		  unsigned nr_bytes,
183		  cpu *processor,
184		  unsigned_word cia)
185{
186  int nr_moved;
187  for (nr_moved = 0; nr_moved < nr_bytes; nr_moved++) {
188    vm_data_map_write_1(cpu_data_map(processor),
189			addr + nr_moved,
190			((const char*)source)[nr_moved],
191			processor, cia);
192  }
193}
194
195
196INLINE_EMUL_GENERIC void
197emul_read_buffer(void *dest,
198		 unsigned_word addr,
199		 unsigned nr_bytes,
200		 cpu *processor,
201		 unsigned_word cia)
202{
203  int nr_moved;
204  for (nr_moved = 0; nr_moved < nr_bytes; nr_moved++) {
205    ((char*)dest)[nr_moved] = vm_data_map_read_1(cpu_data_map(processor),
206						 addr + nr_moved,
207						 processor, cia);
208  }
209}
210
211
212INLINE_EMUL_GENERIC void
213emul_do_system_call(os_emul_data *emul_data,
214		    emul_syscall *emul,
215		    unsigned call,
216		    const int arg0,
217		    cpu *processor,
218		    unsigned_word cia)
219{
220  emul_syscall_handler *handler = NULL;
221  if (call >= emul->nr_system_calls)
222    error("do_call() os_emul call %d out-of-range\n", call);
223
224  handler = emul->syscall_descriptor[call].handler;
225  if (handler == NULL) {
226    if (emul->syscall_descriptor[call].name) {
227      error("do_call() unimplemented call %s\n", emul->syscall_descriptor[call].name);
228    } else {
229      error("do_call() unimplemented call %d\n", call);
230    }
231  }
232
233  if (WITH_TRACE && ppc_trace[trace_os_emul])
234    emul_syscall_enter(emul, call, arg0, processor, cia);
235
236  cpu_registers(processor)->gpr[0] = 0; /* default success */
237  handler(emul_data, call, arg0, processor, cia);
238
239  if (WITH_TRACE && ppc_trace[trace_os_emul])
240    emul_syscall_exit(emul, call, arg0, processor, cia);
241}
242
243
244/* default size for the first bank of memory */
245
246#ifndef OEA_MEMORY_SIZE
247#define OEA_MEMORY_SIZE 0x100000
248#endif
249
250
251/* Add options to the device tree */
252
253INLINE_EMUL_GENERIC void
254emul_add_tree_options(device *tree,
255		      bfd *image,
256		      const char *emul,
257		      const char *env,
258		      int oea_interrupt_prefix)
259{
260  int little_endian = 0;
261
262  /* sort out little endian */
263  if (tree_find_property(tree, "/options/little-endian?"))
264    little_endian = tree_find_boolean_property(tree, "/options/little-endian?");
265  else {
266#ifdef bfd_little_endian	/* new bfd */
267    little_endian = (image != NULL && bfd_little_endian(image));
268#else
269    little_endian = (image != NULL &&
270		     !image->xvec->byteorder_big_p);
271#endif
272    tree_parse(tree, "/options/little-endian? %s",
273	       little_endian ? "true" : "false");
274  }
275
276  /* misc other stuff */
277  tree_parse(tree, "/openprom/options/oea-memory-size 0x%x",
278	     OEA_MEMORY_SIZE);
279  tree_parse(tree, "/openprom/options/oea-interrupt-prefix %d",
280	     oea_interrupt_prefix);
281  tree_parse(tree, "/openprom/options/smp 1");
282  tree_parse(tree, "/openprom/options/env %s", env);
283  tree_parse(tree, "/openprom/options/os-emul %s", emul);
284  tree_parse(tree, "/openprom/options/strict-alignment? %s",
285	     (WITH_ALIGNMENT == STRICT_ALIGNMENT)
286	     ? "true" : "false");
287  tree_parse(tree, "/openprom/options/floating-point? %s",
288	     WITH_FLOATING_POINT ? "true" : "false");
289  tree_parse(tree, "/openprom/options/use-stdio? %s",
290	     ((WITH_STDIO == DO_USE_STDIO
291	       || WITH_STDIO == 0)
292	      ? "true" : "false"));
293  tree_parse(tree, "/openprom/options/model \"%s",
294	     model_name[WITH_DEFAULT_MODEL]);
295  tree_parse(tree, "/openprom/options/model-issue %d",
296	     MODEL_ISSUE_IGNORE);
297
298  /* useful options */
299}
300
301INLINE_EMUL_GENERIC void
302emul_add_tree_hardware(device *root)
303{
304  int i;
305  int nr_cpus = tree_find_integer_property(root, "/openprom/options/smp");
306
307  /* sanity check the number of processors */
308  if (nr_cpus > MAX_NR_PROCESSORS)
309    error("Specified number of processors (%d) exceeds the number configured (%d).\n",
310	  nr_cpus, MAX_NR_PROCESSORS);
311
312  /* set the number of address cells (1 or 2) */
313  tree_parse(root, "#address-cells %d", WITH_TARGET_WORD_BITSIZE / 32);
314
315  /* add some memory */
316  if (tree_find_device(root, "/memory") == NULL) {
317    unsigned_word memory_size =
318      tree_find_integer_property(root, "/openprom/options/oea-memory-size");
319    const unsigned_word avail_start = 0x3000;
320    tree_parse(root, "/memory@0/reg 0x0 0x%lx",
321	       (unsigned long)memory_size);
322    /* reserve the first 0x3000 for the PowerPC interrupt table */
323    tree_parse(root, "/memory@0/available 0x%lx  0x%lx",
324	       (unsigned long)avail_start,
325	       (unsigned long)memory_size - avail_start);
326  }
327
328  /* our processors */
329  for (i = 0; i < nr_cpus; i++) {
330    tree_parse(root, "/cpus/cpu@%d/cpu-nr %d", i, i);
331  }
332
333  /* the debugging pal - hide it in the openprom and don't attach it
334     to any bus */
335  tree_parse(root, "/openprom/pal");
336
337  /* chosen etc */
338  tree_parse(root, "/chosen/stdin */openprom/pal");
339  tree_parse(root, "/chosen/stdout !/chosen/stdin");
340  tree_parse(root, "/chosen/memory */memory");
341}
342
343#endif /* _EMUL_GENERIC_C_ */
344