OpenCores
URL https://opencores.org/ocsvn/openrisc_me/openrisc_me/trunk

Subversion Repositories openrisc_me

[/] [openrisc/] [trunk/] [gnu-src/] [gdb-7.1/] [sim/] [ppc/] [emul_chirp.c] - Blame information for rev 227

Details | Compare with Previous | View Log

Line No. Rev Author Line
1 227 jeremybenn
/*  This file is part of the program psim.
2
 
3
    Copyright 1994, 1995, 1996, 1997, 2003 Andrew Cagney
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_CHIRP_C_
23
#define _EMUL_CHIRP_C_
24
 
25
/* Note: this module is called via a table.  There is no benefit in
26
   making it inline */
27
 
28
#include "emul_generic.h"
29
#include "emul_chirp.h"
30
 
31
#ifdef HAVE_STRING_H
32
#include <string.h>
33
#else
34
#ifdef HAVE_STRINGS_H
35
#include <strings.h>
36
#endif
37
#endif
38
 
39
#ifdef HAVE_UNISTD_H
40
#include <unistd.h>
41
#endif
42
 
43
#ifndef STATIC_INLINE_EMUL_CHIRP
44
#define STATIC_INLINE_EMUL_CHIRP STATIC_INLINE
45
#endif
46
 
47
 
48
/* EMULATION
49
 
50
 
51
   OpenFirmware - IEEE Standard for Boot (Initialization
52
   Configuration) Firmware.
53
 
54
 
55
   DESCRIPTION
56
 
57
 
58
   BUGS
59
 
60
 
61
   This code assumes that the memory node has #address-cells and
62
   #size-cells set to one.  For future implementations, this may not
63
   be the case.
64
 
65
   */
66
 
67
 
68
 
69
 
70
/* Descriptor of the open boot services being emulated */
71
 
72
typedef int (chirp_handler)
73
     (os_emul_data *data,
74
      cpu *processor,
75
      unsigned_word cia);
76
 
77
typedef struct _chirp_services {
78
  const char *name;
79
  chirp_handler *handler;
80
} chirp_services;
81
 
82
 
83
/* The OpenBoot emulation is, at any time either waiting for a client
84
   request or waiting on a client callback */
85
typedef enum {
86
  serving,
87
  emulating,
88
  faulting,
89
} chirp_emul_state;
90
 
91
struct _os_emul_data {
92
  chirp_emul_state state;
93
  unsigned_word return_address;
94
  unsigned_word arguments;
95
  unsigned_word n_args;
96
  unsigned_word n_returns;
97
  chirp_services *service;
98
  device *root;
99
  chirp_services *services;
100
  /* configuration */
101
  unsigned_word memory_size;
102
  unsigned_word real_base;
103
  unsigned_word real_size;
104
  unsigned_word virt_base;
105
  unsigned_word virt_size;
106
  int real_mode;
107
  int little_endian;
108
  int floating_point_available;
109
  int interrupt_prefix;
110
  unsigned_word load_base;
111
  /* hash table */
112
  unsigned_word nr_page_table_entry_groups;
113
  unsigned_word htab_offset;
114
  unsigned_word htab_ra;
115
  unsigned_word htab_va;
116
  unsigned_word sizeof_htab;
117
  /* virtual address of htab */
118
  unsigned_word stack_offset;
119
  unsigned_word stack_ra;
120
  unsigned_word stack_va;
121
  unsigned_word sizeof_stack;
122
  /* addresses of emulation instructions virtual/real */
123
  unsigned_word code_offset;
124
  unsigned_word code_va;
125
  unsigned_word code_ra;
126
  unsigned_word sizeof_code;
127
  unsigned_word code_client_va;
128
  unsigned_word code_client_ra;
129
  unsigned_word code_callback_va;
130
  unsigned_word code_callback_ra;
131
  unsigned_word code_loop_va;
132
  unsigned_word code_loop_ra;
133
};
134
 
135
 
136
/* returns the name of the corresponding Ihandle */
137
static const char *
138
ihandle_name(device_instance *ihandle)
139
{
140
  if (ihandle == NULL)
141
    return "";
142
  else
143
    return device_name(device_instance_device(ihandle));
144
}
145
 
146
 
147
 
148
/* Read/write the argument list making certain that all values are
149
   converted to/from host byte order.
150
 
151
   In the below only n_args+n_returns is read/written */
152
 
153
static int
154
chirp_read_t2h_args(void *args,
155
                    int sizeof_args,
156
                    int n_args,
157
                    int n_returns,
158
                    os_emul_data *data,
159
                    cpu *processor,
160
                    unsigned_word cia)
161
{
162
  unsigned_cell *words;
163
  int i;
164
  /* check against the number of arguments specified by the client
165
     program */
166
  if ((n_args >= 0 && data->n_args != n_args)
167
      || (n_returns >= 0 && data->n_returns != n_returns)) {
168
    TRACE(trace_os_emul, ("%s - invalid nr of args - n_args=%ld, n_returns=%ld\n",
169
                          data->service->name,
170
                          (long)data->n_args,
171
                          (long)data->n_returns));
172
    return -1;
173
  }
174
  /* check that there is enough space */
175
  if (sizeof(unsigned_cell) * (data->n_args + data->n_returns) > sizeof_args)
176
    return -1;
177
  /* bring in the data */
178
  memset(args, 0, sizeof_args);
179
  emul_read_buffer(args, data->arguments + 3 * sizeof(unsigned_cell),
180
                   sizeof(unsigned_cell) * (data->n_args + data->n_returns),
181
                   processor, cia);
182
  /* convert all words to host format */
183
  words = args;
184
  for (i = 0; i < (sizeof_args / sizeof(unsigned_cell)); i++)
185
    words[i] = T2H_cell(words[i]);
186
  return 0;
187
}
188
 
189
static void
190
chirp_write_h2t_args(void *args,
191
                     int sizeof_args,
192
                     os_emul_data *data,
193
                     cpu *processor,
194
                     unsigned_word cia)
195
{
196
  int i;
197
  unsigned_cell *words;
198
  /* convert to target everything */
199
  words = args;
200
  for (i = 0; i < (sizeof_args / sizeof(unsigned_cell)); i++)
201
    words[i] = H2T_cell(words[i]);
202
  /* bring in the data */
203
  emul_write_buffer(args, data->arguments + 3 * sizeof(unsigned_cell),
204
                    sizeof(unsigned_cell) * (data->n_args + data->n_returns),
205
                    processor, cia);
206
}
207
 
208
 
209
/* OpenBoot emulation functions */
210
 
211
/* client interface */
212
 
213
static int
214
chirp_emul_test(os_emul_data *data,
215
                cpu *processor,
216
                unsigned_word cia)
217
{
218
  struct test_args {
219
    /*in*/
220
    unsigned_cell name; /*string*/
221
    /*out*/
222
    unsigned_cell missing;
223
  } args;
224
  char name[32];
225
  chirp_services *service = NULL;
226
  /* read in the arguments */
227
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 1, data, processor, cia))
228
    return -1;
229
  emul_read_string(name, args.name, sizeof(name),
230
                   processor, cia);
231
  TRACE(trace_os_emul, ("test - in - name=`%s'\n", name));
232
  /* see if we know about the service */
233
  service = data->services;
234
  while (service->name != NULL && strcmp(service->name, name) != 0) {
235
    service++;
236
  }
237
  if (service->name == NULL)
238
    args.missing = -1;
239
  else
240
    args.missing = 0;
241
  /* write the arguments back out */
242
  TRACE(trace_os_emul, ("test - out - missing=%ld\n",
243
                        (long)args.missing));
244
  chirp_write_h2t_args(&args,
245
                       sizeof(args),
246
                       data,
247
                       processor, cia);
248
  return 0;
249
}
250
 
251
 
252
/* Device tree */
253
 
254
static int
255
chirp_emul_peer(os_emul_data *data,
256
                cpu *processor,
257
                unsigned_word cia)
258
{
259
  struct peer_args {
260
    /*in*/
261
    unsigned_cell phandle;
262
    /*out*/
263
    unsigned_cell sibling_phandle;
264
  } args;
265
  device *phandle;
266
  device *sibling_phandle = NULL;
267
  /* read in the arguments */
268
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 1, data, processor, cia))
269
    return -1;
270
  phandle = external_to_device(data->root, args.phandle);
271
  TRACE(trace_os_emul, ("peer - in - phandle=0x%lx(0x%lx`%s')\n",
272
                        (unsigned long)args.phandle,
273
                        (unsigned long)phandle,
274
                        (phandle == NULL ? "" : device_name(phandle))));
275
  /* find the peer */
276
  if (args.phandle == 0) {
277
    sibling_phandle = data->root;
278
    args.sibling_phandle = device_to_external(sibling_phandle);
279
  }
280
  else if (phandle == NULL) {
281
    sibling_phandle = NULL;
282
    args.sibling_phandle = -1;
283
  }
284
  else {
285
    sibling_phandle = device_sibling(phandle);
286
    if (sibling_phandle == NULL)
287
      args.sibling_phandle = 0;
288
    else
289
      args.sibling_phandle = device_to_external(sibling_phandle);
290
  }
291
  /* write the arguments back out */
292
  TRACE(trace_os_emul, ("peer - out - sibling_phandle=0x%lx(0x%lx`%s')\n",
293
                        (unsigned long)args.sibling_phandle,
294
                        (unsigned long)sibling_phandle,
295
                        (sibling_phandle == NULL ? "" : device_name(sibling_phandle))));
296
  chirp_write_h2t_args(&args,
297
                       sizeof(args),
298
                       data,
299
                       processor, cia);
300
  return 0;
301
}
302
 
303
static int
304
chirp_emul_child(os_emul_data *data,
305
                 cpu *processor,
306
                 unsigned_word cia)
307
{
308
  struct child_args {
309
    /*in*/
310
    unsigned_cell phandle;
311
    /*out*/
312
    unsigned_cell child_phandle;
313
  } args;
314
  device *phandle;
315
  device *child_phandle;
316
  /* read the arguments in */
317
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 1, data, processor, cia))
318
    return -1;
319
  phandle = external_to_device(data->root, args.phandle);
320
  TRACE(trace_os_emul, ("child - in - phandle=0x%lx(0x%lx`%s')\n",
321
                        (unsigned long)args.phandle,
322
                        (unsigned long)phandle,
323
                        (phandle == NULL ? "" : device_name(phandle))));
324
  /* find a child */
325
  if (args.phandle == 0
326
      || phandle == NULL) {
327
    child_phandle = NULL;
328
    args.child_phandle = -1;
329
  }
330
  else {
331
    child_phandle = device_child(phandle);
332
    if (child_phandle == NULL)
333
      args.child_phandle = 0;
334
    else
335
      args.child_phandle = device_to_external(child_phandle);
336
  }
337
  /* write the result out */
338
  TRACE(trace_os_emul, ("child - out - child_phandle=0x%lx(0x%lx`%s')\n",
339
                        (unsigned long)args.child_phandle,
340
                        (unsigned long)child_phandle,
341
                        (child_phandle == NULL ? "" : device_name(child_phandle))));
342
  chirp_write_h2t_args(&args,
343
                       sizeof(args),
344
                       data,
345
                       processor, cia);
346
  return 0;
347
}
348
 
349
static int
350
chirp_emul_parent(os_emul_data *data,
351
                  cpu *processor,
352
                  unsigned_word cia)
353
{
354
  struct parent_args {
355
    /*in*/
356
    unsigned_cell phandle;
357
    /*out*/
358
    unsigned_cell parent_phandle;
359
  } args;
360
  device *phandle;
361
  device *parent_phandle;
362
  /* read the args in */
363
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 1, data, processor, cia))
364
    return -1;
365
  phandle = external_to_device(data->root, args.phandle);
366
  TRACE(trace_os_emul, ("parent - in - phandle=0x%lx(0x%lx`%s')\n",
367
                        (unsigned long)args.phandle,
368
                        (unsigned long)phandle,
369
                        (phandle == NULL ? "" : device_name(phandle))));
370
  /* find a parent */
371
  if (args.phandle == 0
372
      || phandle == NULL) {
373
    parent_phandle = NULL;
374
    args.parent_phandle = -1;
375
  }
376
  else {
377
    parent_phandle = device_parent(phandle);
378
    if (parent_phandle == NULL)
379
      args.parent_phandle = 0;
380
    else
381
      args.parent_phandle = device_to_external(parent_phandle);
382
  }
383
  /* return the result */
384
  TRACE(trace_os_emul, ("parent - out - parent_phandle=0x%lx(0x%lx`%s')\n",
385
                        (unsigned long)args.parent_phandle,
386
                        (unsigned long)parent_phandle,
387
                        (parent_phandle == NULL ? "" : device_name(parent_phandle))));
388
  chirp_write_h2t_args(&args,
389
                       sizeof(args),
390
                       data,
391
                       processor, cia);
392
  return 0;
393
}
394
 
395
static int
396
chirp_emul_instance_to_package(os_emul_data *data,
397
                               cpu *processor,
398
                               unsigned_word cia)
399
{
400
  struct instance_to_package_args {
401
    /*in*/
402
    unsigned_cell ihandle;
403
    /*out*/
404
    unsigned_cell phandle;
405
  } args;
406
  device_instance *ihandle;
407
  device *phandle = NULL;
408
  /* read the args in */
409
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 1, data, processor, cia))
410
    return -1;
411
  ihandle = external_to_device_instance(data->root, args.ihandle);
412
  TRACE(trace_os_emul, ("instance-to-package - in - ihandle=0x%lx(0x%lx`%s')\n",
413
                        (unsigned long)args.ihandle,
414
                        (unsigned long)ihandle,
415
                        ihandle_name(ihandle)));
416
  /* find the corresponding phandle */
417
  if (ihandle == NULL) {
418
    phandle = NULL;
419
    args.phandle = -1;
420
  }
421
  else {
422
    phandle = device_instance_device(ihandle);
423
    args.phandle = device_to_external(phandle);
424
  }
425
  /* return the result */
426
  TRACE(trace_os_emul, ("instance-to-package - out - phandle=0x%lx(0x%lx`%s')\n",
427
                        (unsigned long)args.phandle,
428
                        (unsigned long)phandle,
429
                        (phandle == NULL ? "" : device_name(phandle))));
430
  chirp_write_h2t_args(&args,
431
                       sizeof(args),
432
                       data,
433
                       processor, cia);
434
  return 0;
435
}
436
 
437
static int
438
chirp_emul_getproplen(os_emul_data *data,
439
                      cpu *processor,
440
                      unsigned_word cia)
441
{
442
  struct getproplen_args {
443
    /*in*/
444
    unsigned_cell phandle;
445
    unsigned_cell name;
446
    /*out*/
447
    unsigned_cell proplen;
448
  } args;
449
  char name[32];
450
  device *phandle;
451
  /* read the args in */
452
  if (chirp_read_t2h_args(&args, sizeof(args), 2, 1, data, processor, cia))
453
    return -1;
454
  phandle = external_to_device(data->root, args.phandle);
455
  emul_read_string(name,
456
                   args.name,
457
                   sizeof(name),
458
                   processor, cia);
459
  TRACE(trace_os_emul, ("getproplen - in - phandle=0x%lx(0x%lx`%s') name=`%s'\n",
460
                        (unsigned long)args.phandle,
461
                        (unsigned long)phandle,
462
                        (phandle == NULL ? "" : device_name(phandle)),
463
                        name));
464
  /* find our prop and get its length */
465
  if (args.phandle == 0
466
      || phandle == NULL) {
467
    args.proplen = -1;
468
  }
469
  else {
470
    const device_property *prop = device_find_property(phandle, name);
471
    if (prop == (device_property*)0) {
472
      args.proplen = -1;
473
    }
474
    else {
475
      args.proplen = prop->sizeof_array;
476
    }
477
  }
478
  /* return the result */
479
  TRACE(trace_os_emul, ("getproplen - out - proplen=%ld\n",
480
                        (unsigned long)args.proplen));
481
  chirp_write_h2t_args(&args,
482
                       sizeof(args),
483
                       data,
484
                       processor, cia);
485
  return 0;
486
}
487
 
488
static int
489
chirp_emul_getprop(os_emul_data *data,
490
                   cpu *processor,
491
                   unsigned_word cia)
492
{
493
  struct getprop_args {
494
    /*in*/
495
    unsigned_cell phandle;
496
    unsigned_cell name;
497
    unsigned_cell buf;
498
    unsigned_cell buflen;
499
    /*out*/
500
    unsigned_cell size;
501
  } args;
502
  char name[32];
503
  device *phandle;
504
  /* read in the args, the return is optional */
505
  if (chirp_read_t2h_args(&args, sizeof(args), 4, -1, data, processor, cia))
506
    return -1;
507
  phandle = external_to_device(data->root, args.phandle);
508
  emul_read_string(name,
509
                   args.name,
510
                   sizeof(name),
511
                   processor, cia);
512
  TRACE(trace_os_emul, ("getprop - in - phandle=0x%lx(0x%lx`%s') name=`%s' buf=0x%lx buflen=%ld\n",
513
                        (unsigned long)args.phandle,
514
                        (unsigned long)phandle,
515
                        (phandle == NULL ? "" : device_name(phandle)),
516
                        name,
517
                        (unsigned long)args.buf,
518
                        (unsigned long)args.buflen));
519
  /* get the property */
520
  if (args.phandle == 0
521
      || phandle == NULL) {
522
    args.size = -1;
523
  }
524
  else {
525
    const device_property *prop = device_find_property(phandle, name);
526
    if (prop == NULL) {
527
      args.size = -1;
528
    }
529
    else {
530
      int size = args.buflen;
531
      if (size > prop->sizeof_array)
532
        size = prop->sizeof_array;
533
      emul_write_buffer(prop->array, args.buf,
534
                        size,
535
                        processor, cia);
536
      args.size = size;
537
      switch (prop->type) {
538
      case string_property:
539
        TRACE(trace_os_emul, ("getprop - string `%s'\n",
540
                              device_find_string_property(phandle, name)));
541
        break;
542
      case ihandle_property:
543
        TRACE(trace_os_emul, ("getprop - ihandle=0x%lx(0x%lx`%s')\n",
544
                              BE2H_cell(*(unsigned_cell*)prop->array),
545
                              (unsigned long)device_find_ihandle_property(phandle, name),
546
                              ihandle_name(device_find_ihandle_property(phandle, name))));
547
        break;
548
      default:
549
        break;
550
      }
551
    }
552
  }
553
  /* write back the result */
554
  if (data->n_returns == 0)
555
    TRACE(trace_os_emul, ("getprop - out - size=%ld (not returned)\n",
556
                          (unsigned long)args.size));
557
  else {
558
    TRACE(trace_os_emul, ("getprop - out - size=%ld\n",
559
                          (unsigned long)args.size));
560
    chirp_write_h2t_args(&args,
561
                         sizeof(args),
562
                         data,
563
                         processor, cia);
564
  }
565
  return 0;
566
}
567
 
568
static int
569
chirp_emul_nextprop(os_emul_data *data,
570
                    cpu *processor,
571
                    unsigned_word cia)
572
{
573
  struct nextprop_args {
574
    /*in*/
575
    unsigned_cell phandle;
576
    unsigned_cell previous;
577
    unsigned_cell buf;
578
    /*out*/
579
    unsigned_cell flag;
580
  } args;
581
  char previous[32];
582
  device *phandle;
583
  /* read in the args */
584
  if (chirp_read_t2h_args(&args, sizeof(args), 3, 1, data, processor, cia))
585
    return -1;
586
  phandle = external_to_device(data->root, args.phandle);
587
  if (args.previous != 0)
588
    emul_read_string(previous,
589
                     args.previous,
590
                     sizeof(previous),
591
                     processor, cia);
592
  else
593
    /* If previous is NULL, make it look like the empty string.  The
594
       next property after the empty string is the first property.  */
595
    strcpy (previous, "");
596
  TRACE(trace_os_emul, ("nextprop - in - phandle=0x%lx(0x%lx`%s') previous=`%s' buf=0x%lx\n",
597
                        (unsigned long)args.phandle,
598
                        (unsigned long)phandle,
599
                        (phandle == NULL ? "" : device_name(phandle)),
600
                        previous,
601
                        (unsigned long)args.buf));
602
  /* find the next property */
603
  if (args.phandle == 0
604
      || phandle == NULL) {
605
    args.flag = -1;
606
  }
607
  else {
608
    const device_property *prev_prop = device_find_property(phandle, previous);
609
    if (prev_prop == NULL) {
610
      if (strcmp (previous, "") == 0)
611
        args.flag = 0; /* No properties */
612
      else
613
        args.flag = -1; /* name invalid */
614
    }
615
    else {
616
      const device_property *next_prop;
617
      if (strcmp (previous, "") == 0) {
618
        next_prop = prev_prop;  /* The first property.  */
619
      }
620
      else {
621
        next_prop = device_next_property(prev_prop);
622
      }
623
      if (next_prop == NULL) {
624
        args.flag = 0; /* last property */
625
      }
626
      else {
627
        emul_write_buffer(next_prop->name, args.buf, strlen(next_prop->name),
628
                          processor, cia);
629
        TRACE(trace_os_emul, ("nextprop - name=`%s'\n", next_prop->name));
630
        args.flag = 1; /* worked ok */
631
      }
632
    }
633
  }
634
  /* write back the result */
635
  TRACE(trace_os_emul, ("nextprop - out - flag=%ld\n",
636
                        (unsigned long)args.flag));
637
  chirp_write_h2t_args(&args,
638
                       sizeof(args),
639
                       data,
640
                       processor, cia);
641
  return 0;
642
}
643
 
644
#if 0
645
static int
646
chirp_emul_setprop(os_emul_data *data,
647
                   cpu *processor,
648
                   unsigned_word cia)
649
{
650
  error("chirp: setprop method not implemented\n");
651
  return 0;
652
}
653
#endif
654
 
655
static int
656
chirp_emul_canon(os_emul_data *data,
657
                 cpu *processor,
658
                 unsigned_word cia)
659
{
660
  struct canon_args {
661
    /*in*/
662
    unsigned_cell device_specifier;
663
    unsigned_cell buf;
664
    unsigned_cell buflen;
665
    /*out*/
666
    unsigned_cell length;
667
  } args;
668
  char device_specifier[1024];
669
  device *phandle;
670
  const char *path;
671
  int length;
672
  /* read in the args */
673
  if (chirp_read_t2h_args(&args, sizeof(args), 3, 1, data, processor, cia))
674
    return -1;
675
  emul_read_string(device_specifier,
676
                   args.device_specifier,
677
                   sizeof(device_specifier),
678
                   processor, cia);
679
  TRACE(trace_os_emul, ("canon - in - device_specifier=`%s' buf=0x%lx buflen=%lx\n",
680
                        device_specifier,
681
                        (unsigned long)args.buf,
682
                        (unsigned long)args.buflen));
683
  /* canon the name */
684
  phandle = tree_find_device(data->root, device_specifier);
685
  if (phandle == NULL) {
686
    length = -1;
687
    path = "";
688
    args.length = -1;
689
  }
690
  else {
691
    path = device_path(phandle);
692
    length = strlen(path);
693
    if (length >= args.buflen)
694
      length = args.buflen - 1;
695
    emul_write_buffer(path, args.buf, length,
696
                      processor, cia);
697
    args.length = length;
698
  }
699
  /* write back the result */
700
  TRACE(trace_os_emul, ("canon - out - length=%ld buf=`%s'\n",
701
                        (unsigned long)args.length,
702
                        path));
703
  chirp_write_h2t_args(&args,
704
                       sizeof(args),
705
                       data,
706
                       processor, cia);
707
  return 0;
708
}
709
 
710
static int
711
chirp_emul_finddevice(os_emul_data *data,
712
                      cpu *processor,
713
                      unsigned_word cia)
714
{
715
  struct finddevice_args {
716
    /*in*/
717
    unsigned_cell device_specifier;
718
    /*out*/
719
    unsigned_cell phandle;
720
  } args;
721
  char device_specifier[1024];
722
  device *phandle;
723
  /* get the args */
724
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 1, data, processor, cia))
725
    return -1;
726
  emul_read_string(device_specifier,
727
                   args.device_specifier,
728
                   sizeof(device_specifier),
729
                   processor, cia);
730
  TRACE(trace_os_emul, ("finddevice - in - device_specifier=`%s'\n",
731
                        device_specifier));
732
  /* find the device */
733
  phandle = tree_find_device(data->root, device_specifier);
734
  if (phandle == NULL)
735
    args.phandle = -1;
736
  else
737
    args.phandle = device_to_external(phandle);
738
  /* return its phandle */
739
  TRACE(trace_os_emul, ("finddevice - out - phandle=0x%lx(0x%lx`%s')\n",
740
                        (unsigned long)args.phandle,
741
                        (unsigned long)phandle,
742
                        (phandle == NULL ? "" : device_name(phandle))));
743
  chirp_write_h2t_args(&args,
744
                       sizeof(args),
745
                       data,
746
                       processor, cia);
747
  return 0;
748
}
749
 
750
static int
751
chirp_emul_instance_to_path(os_emul_data *data,
752
                            cpu *processor,
753
                            unsigned_word cia)
754
{
755
  struct instance_to_path_args {
756
    /*in*/
757
    unsigned_cell ihandle;
758
    unsigned_cell buf;
759
    unsigned_cell buflen;
760
    /*out*/
761
    unsigned_cell length;
762
  } args;
763
  device_instance *ihandle;
764
  const char *path;
765
  int length;
766
  /* get the args */
767
  if (chirp_read_t2h_args(&args, sizeof(args), 3, 1, data, processor, cia))
768
    return -1;
769
  ihandle = external_to_device_instance(data->root, args.ihandle);
770
  TRACE(trace_os_emul, ("instance-to-path - in - ihandle=0x%lx(0x%lx`%s') buf=0x%lx buflen=%ld\n",
771
                        (unsigned long)args.ihandle,
772
                        (unsigned long)ihandle,
773
                        ihandle_name(ihandle),
774
                        (unsigned long)args.buf,
775
                        (unsigned long)args.buflen));
776
  /* get the devices name */
777
  if (ihandle == NULL) {
778
    args.length = -1;
779
    path = "(null)";
780
  }
781
  else {
782
    path = device_instance_path(ihandle);
783
    length = strlen(path);
784
    if (length >= args.buflen)
785
      length = args.buflen - 1;
786
    emul_write_buffer(path, args.buf, length,
787
                      processor, cia);
788
    args.length = length;
789
  }
790
  /* return its phandle */
791
  TRACE(trace_os_emul, ("instance-to-path - out - length=%ld buf=`%s')\n",
792
                        (unsigned long)args.length,
793
                        path));
794
  chirp_write_h2t_args(&args,
795
                       sizeof(args),
796
                       data,
797
                       processor, cia);
798
  return 0;
799
}
800
 
801
static int
802
chirp_emul_package_to_path(os_emul_data *data,
803
                           cpu *processor,
804
                           unsigned_word cia)
805
{
806
  struct package_to_path_args {
807
    /*in*/
808
    unsigned_cell phandle;
809
    unsigned_cell buf;
810
    unsigned_cell buflen;
811
    /*out*/
812
    unsigned_cell length;
813
  } args;
814
  device *phandle;
815
  const char *path;
816
  /* get the args */
817
  if (chirp_read_t2h_args(&args, sizeof(args), 3, 1, data, processor, cia))
818
    return -1;
819
  phandle = external_to_device(data->root, args.phandle);
820
  TRACE(trace_os_emul, ("package-to-path - in - phandle=0x%lx(0x%lx`%s') buf=0x%lx buflen=%ld\n",
821
                        (unsigned long)args.phandle,
822
                        (unsigned long)phandle,
823
                        (phandle == NULL ? "" : device_name(phandle)),
824
                        (unsigned long)args.buf,
825
                        (unsigned long)args.buflen));
826
  /* get the devices name */
827
  if (phandle == NULL) {
828
    args.length = -1;
829
    path = "(null)";
830
  }
831
  else {
832
    int length;
833
    path = device_path(phandle);
834
    length = strlen(path);
835
    if (length >= args.buflen)
836
      length = args.buflen - 1;
837
    emul_write_buffer(path, args.buf, length,
838
                      processor, cia);
839
    args.length = length;
840
  }
841
  /* return its phandle */
842
  TRACE(trace_os_emul, ("package-to-path - out - length=%ld buf=`%s')\n",
843
                        (unsigned long)args.length,
844
                        path));
845
  chirp_write_h2t_args(&args,
846
                       sizeof(args),
847
                       data,
848
                       processor, cia);
849
  return 0;
850
}
851
 
852
static int
853
chirp_emul_call_method(os_emul_data *data,
854
                       cpu *processor,
855
                       unsigned_word cia)
856
{
857
  struct call_method_args {
858
    /*in*/
859
    unsigned_cell method;
860
    unsigned_cell ihandle;
861
    /*in/out*/
862
    unsigned_cell stack[13]; /*6in + 6out + catch */
863
  } args;
864
  char method[32];
865
  device_instance *ihandle;
866
  /* some useful info about our mini stack */
867
  int n_stack_args;
868
  int n_stack_returns;
869
  int stack_catch_result;
870
  int stack_returns;
871
  /* read the args */
872
  if (chirp_read_t2h_args(&args, sizeof(args), -1, -1, data, processor, cia))
873
    return -1;
874
  emul_read_string(method,
875
                   args.method,
876
                   sizeof(method),
877
                   processor, cia);
878
  ihandle = external_to_device_instance(data->root, args.ihandle);
879
  n_stack_args = data->n_args - 2;
880
  n_stack_returns = data->n_returns - 1;
881
  stack_catch_result = n_stack_args;
882
  stack_returns = stack_catch_result + 1;
883
  TRACE(trace_os_emul, ("call-method - in - n_args=%ld n_returns=%ld method=`%s' ihandle=0x%lx(0x%lx`%s')\n",
884
                        (unsigned long)data->n_args,
885
                        (unsigned long)data->n_returns,
886
                        method,
887
                        (unsigned long)args.ihandle,
888
                        (unsigned long)ihandle,
889
                        ihandle_name(ihandle)));
890
  /* see if we can emulate this method */
891
  if (ihandle == NULL) {
892
    /* OpenFirmware doesn't define this error */
893
    error("chirp: invalid ihandle passed to call-method method");
894
  }
895
  else {
896
    args.stack[stack_catch_result] =
897
      device_instance_call_method(ihandle,
898
                                  method,
899
                                  n_stack_args,
900
                                  &args.stack[0],
901
                                  n_stack_returns,
902
                                  &args.stack[stack_returns]);
903
  }
904
  /* finished */
905
  TRACE(trace_os_emul, ("call-method - out - catch-result=%ld\n",
906
                        (unsigned long)args.stack[stack_catch_result]));
907
  chirp_write_h2t_args(&args,
908
                       sizeof(args),
909
                       data,
910
                       processor, cia);
911
  return 0;
912
}
913
 
914
 
915
/* Device I/O */
916
 
917
static int
918
chirp_emul_open(os_emul_data *data,
919
                cpu *processor,
920
                unsigned_word cia)
921
{
922
  struct open_args {
923
    /*in*/
924
    unsigned_cell device_specifier;
925
    /*out*/
926
    unsigned_cell ihandle;
927
  } args;
928
  char device_specifier[1024];
929
  device_instance *ihandle;
930
  /* read the args */
931
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 1, data, processor, cia))
932
    return -1;
933
  emul_read_string(device_specifier,
934
                   args.device_specifier,
935
                   sizeof(device_specifier),
936
                   processor, cia);
937
  TRACE(trace_os_emul, ("open - in - device_specifier=`%s'\n",
938
                        device_specifier));
939
  /* open the device */
940
  ihandle = tree_instance(data->root, device_specifier);
941
  if (ihandle == NULL)
942
    args.ihandle = -1;
943
  else
944
    args.ihandle = device_instance_to_external(ihandle);
945
  /* return the ihandle result */
946
  TRACE(trace_os_emul, ("open - out - ihandle=0x%lx(0x%lx`%s')\n",
947
                        (unsigned long)args.ihandle,
948
                        (unsigned long)ihandle,
949
                        ihandle_name(ihandle)));
950
  chirp_write_h2t_args(&args,
951
                       sizeof(args),
952
                       data,
953
                       processor, cia);
954
  return 0;
955
}
956
 
957
static int
958
chirp_emul_close(os_emul_data *data,
959
                 cpu *processor,
960
                 unsigned_word cia)
961
{
962
  struct close_args {
963
    /*in*/
964
    unsigned_cell ihandle;
965
    /*out*/
966
  } args;
967
  device_instance *ihandle;
968
  /* read the args */
969
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 0, data, processor, cia))
970
    return -1;
971
  ihandle = external_to_device_instance(data->root, args.ihandle);
972
  TRACE(trace_os_emul, ("close - in - ihandle=0x%lx(0x%lx`%s')\n",
973
                        (unsigned long)args.ihandle,
974
                        (unsigned long)ihandle,
975
                        ihandle_name(ihandle)));
976
  /* close the device */
977
  if (ihandle == NULL) {
978
    /* OpenFirmware doesn't define this error */
979
    error("chirp: invalid ihandle passed to close method");
980
  }
981
  else {
982
    device_instance_delete(ihandle);
983
  }
984
  /* return the ihandle result */
985
  TRACE(trace_os_emul, ("close - out\n"));
986
  chirp_write_h2t_args(&args,
987
                       sizeof(args),
988
                       data,
989
                       processor, cia);
990
  return 0;
991
}
992
 
993
static int
994
chirp_emul_read(os_emul_data *data,
995
                cpu *processor,
996
                unsigned_word cia)
997
{
998
  struct read_args {
999
    /*in*/
1000
    unsigned_cell ihandle;
1001
    unsigned_cell addr;
1002
    unsigned_cell len;
1003
    /*out*/
1004
    unsigned_cell actual;
1005
  } args;
1006
  char buf[1024];
1007
  device_instance *ihandle;
1008
  /* read the args */
1009
  if (chirp_read_t2h_args(&args, sizeof(args), 3, 1, data, processor, cia))
1010
    return -1;
1011
  ihandle = external_to_device_instance(data->root, args.ihandle);
1012
  TRACE(trace_os_emul, ("read - in - ihandle=0x%lx(0x%lx`%s') addr=0x%lx len=%ld\n",
1013
                        (unsigned long)args.ihandle,
1014
                        (unsigned long)ihandle,
1015
                        ihandle_name(ihandle),
1016
                        (unsigned long)args.addr,
1017
                        (unsigned long)args.len));
1018
  if (ihandle == NULL) {
1019
    /* OpenFirmware doesn't define this error */
1020
    error("chirp: invalid ihandle passed to read method");
1021
  }
1022
  else {
1023
    /* do the reads */
1024
    int actual = 0;
1025
    while (actual < args.len) {
1026
      int remaining = args.len - actual;
1027
      int to_read = (remaining <= sizeof(buf) ? remaining : sizeof(buf));
1028
      int nr_read = device_instance_read(ihandle, buf, to_read);
1029
      if (nr_read < 0) {
1030
        actual = nr_read; /* the error */
1031
        break;
1032
      }
1033
      else if (nr_read == 0) {
1034
        break;
1035
      }
1036
      emul_write_buffer(buf,
1037
                        args.addr + actual,
1038
                        nr_read,
1039
                        processor, cia);
1040
      actual += nr_read;
1041
    }
1042
    if (actual >= 0) {
1043
      args.actual = actual;
1044
      if (actual < sizeof(buf))
1045
        buf[actual] = '\0';
1046
      else
1047
        buf[sizeof(buf) - 1] = '\0';
1048
    }
1049
    else {
1050
      switch (actual) {
1051
      case sim_io_eof:
1052
        args.actual = 0;
1053
        break;
1054
      case sim_io_not_ready:
1055
        ASSERT(sim_io_not_ready == -2);
1056
        args.actual = sim_io_not_ready;
1057
        break;
1058
      default:
1059
        error("Bad error value %ld", (long)actual);
1060
        break;
1061
      }
1062
    }
1063
  }
1064
  /* return the result */
1065
  TRACE(trace_os_emul, ("read - out - actual=%ld `%s'\n",
1066
                        (long)args.actual,
1067
                        ((args.actual > 0 && args.actual < sizeof(buf)) ? buf : "")
1068
                        ));
1069
  chirp_write_h2t_args(&args,
1070
                       sizeof(args),
1071
                       data,
1072
                       processor, cia);
1073
  return 0;
1074
}
1075
 
1076
static int
1077
chirp_emul_write(os_emul_data *data,
1078
                 cpu *processor,
1079
                 unsigned_word cia)
1080
{
1081
  struct write_args {
1082
    /*in*/
1083
    unsigned_cell ihandle;
1084
    unsigned_cell addr;
1085
    unsigned_cell len;
1086
    /*out*/
1087
    unsigned_cell actual;
1088
  } args;
1089
  char buf[1024];
1090
  device_instance *ihandle;
1091
  int actual;
1092
  /* get the args */
1093
  if (chirp_read_t2h_args(&args, sizeof(args), 3, 1, data, processor, cia))
1094
    return -1;
1095
  actual = args.len;
1096
  if (actual >= sizeof(buf))
1097
    actual = sizeof(buf) - 1;
1098
  emul_read_buffer(buf,
1099
                   args.addr,
1100
                   actual,
1101
                   processor, cia);
1102
  buf[actual] = '\0';
1103
  ihandle = external_to_device_instance(data->root, args.ihandle);
1104
  TRACE(trace_os_emul, ("write - in - ihandle=0x%lx(0x%lx`%s') `%s' (%ld)\n",
1105
                        (unsigned long)args.ihandle,
1106
                        (unsigned long)ihandle,
1107
                        ihandle_name(ihandle),
1108
                        buf, (long)actual));
1109
  if (ihandle == NULL) {
1110
    /* OpenFirmware doesn't define this error */
1111
    error("chirp: invalid ihandle passed to write method");
1112
  }
1113
  else {
1114
    /* write it out */
1115
    actual = device_instance_write(ihandle, buf, actual);
1116
    if (actual < 0)
1117
      args.actual = 0;
1118
    else
1119
      args.actual = actual;
1120
  }
1121
  /* return the result */
1122
  TRACE(trace_os_emul, ("write - out - actual=%ld\n",
1123
                        (long)args.actual));
1124
  chirp_write_h2t_args(&args,
1125
                       sizeof(args),
1126
                       data,
1127
                       processor, cia);
1128
  return 0;
1129
}
1130
 
1131
static int
1132
chirp_emul_seek(os_emul_data *data,
1133
                cpu *processor,
1134
                unsigned_word cia)
1135
{
1136
  struct seek_args {
1137
    /*in*/
1138
    unsigned_cell ihandle;
1139
    unsigned_cell pos_hi;
1140
    unsigned_cell pos_lo;
1141
    /*out*/
1142
    unsigned_cell status;
1143
  } args;
1144
  int status;
1145
  device_instance *ihandle;
1146
  /* get the args */
1147
  if (chirp_read_t2h_args(&args, sizeof(args), 3, 1, data, processor, cia))
1148
    return -1;
1149
  ihandle = external_to_device_instance(data->root, args.ihandle);
1150
  TRACE(trace_os_emul, ("seek - in - ihandle=0x%lx(0x%lx`%s') pos.hi=0x%lx pos.lo=0x%lx\n",
1151
                        (unsigned long)args.ihandle,
1152
                        (unsigned long)ihandle,
1153
                        ihandle_name(ihandle),
1154
                        args.pos_hi, args.pos_lo));
1155
  if (ihandle == NULL) {
1156
    /* OpenFirmware doesn't define this error */
1157
    error("chirp: invalid ihandle passed to seek method");
1158
  }
1159
  else {
1160
    /* seek it out */
1161
    status = device_instance_seek(ihandle, args.pos_hi, args.pos_lo);
1162
    args.status = status;
1163
  }
1164
  /* return the result */
1165
  TRACE(trace_os_emul, ("seek - out - status=%ld\n",
1166
                        (long)args.status));
1167
  chirp_write_h2t_args(&args,
1168
                       sizeof(args),
1169
                       data,
1170
                       processor, cia);
1171
  return 0;
1172
}
1173
 
1174
 
1175
/* memory */
1176
 
1177
static int
1178
chirp_emul_claim(os_emul_data *data,
1179
                 cpu *processor,
1180
                 unsigned_word cia)
1181
{
1182
  /* NOTE: the client interface claim routine is *very* different to
1183
     the "claim" method described in IEEE-1275 appendix A.  The latter
1184
     uses real addresses while this uses virtual (effective)
1185
     addresses. */
1186
  struct claim_args {
1187
    /* in */
1188
    unsigned_cell virt;
1189
    unsigned_cell size;
1190
    unsigned_cell align;
1191
    /* out */
1192
    unsigned_cell baseaddr;
1193
  } args;
1194
  /* read the args */
1195
  if (chirp_read_t2h_args(&args, sizeof(args),
1196
                          3 /*n_args*/, 1 /*n_returns*/,
1197
                          data, processor, cia))
1198
    return -1;
1199
  TRACE(trace_os_emul, ("claim - in - virt=0x%lx size=%ld align=%d\n",
1200
                        (unsigned long)args.virt,
1201
                        (long int)args.size,
1202
                        (int)args.align));
1203
  /* use the memory device to allocate (real) memory at the requested
1204
     address */
1205
  {
1206
    device_instance *memory = tree_find_ihandle_property(data->root, "/chosen/memory");
1207
    unsigned_cell mem_in[3];
1208
    unsigned_cell mem_out[1];
1209
    mem_in[0] = args.align; /*top-of-stack*/
1210
    mem_in[1] = args.size;
1211
    mem_in[2] = args.virt;
1212
    if (device_instance_call_method(memory, "claim",
1213
                                    3, mem_in, 1, mem_out) < 0)
1214
      error("chirp: claim failed to allocate memory virt=0x%lx size=%ld align=%d",
1215
            (unsigned long)args.virt,
1216
            (long int)args.size,
1217
            (int)args.align);
1218
    args.baseaddr = mem_out[0];
1219
  }
1220
  /* if using virtual addresses, create a 1-1 map of this address space */
1221
  if (!data->real_mode) {
1222
    error("chirp: claim method does not support virtual mode");
1223
  }
1224
  /* return the base address */
1225
  TRACE(trace_os_emul, ("claim - out - baseaddr=0x%lx\n",
1226
                        (unsigned long)args.baseaddr));
1227
  chirp_write_h2t_args(&args,
1228
                       sizeof(args),
1229
                       data,
1230
                       processor, cia);
1231
  return 0;
1232
}
1233
 
1234
static int
1235
chirp_emul_release(os_emul_data *data,
1236
                   cpu *processor,
1237
                   unsigned_word cia)
1238
{
1239
  /* NOTE: the client interface release routine is *very* different to
1240
     the "claim" method described in IEEE-1275 appendix A.  The latter
1241
     uses real addresses while this uses virtual (effective)
1242
     addresses. */
1243
  struct claim_args {
1244
    /* in */
1245
    unsigned_cell virt;
1246
    unsigned_cell size;
1247
    /* out */
1248
  } args;
1249
  /* read the args */
1250
  if (chirp_read_t2h_args(&args, sizeof(args),
1251
                          2 /*n_args*/, 0 /*n_returns*/,
1252
                          data, processor, cia))
1253
    return -1;
1254
  TRACE(trace_os_emul, ("release - in - virt=0x%lx size=%ld\n",
1255
                        (unsigned long)args.virt,
1256
                        (long int)args.size));
1257
  /* use the memory device to release (real) memory at the requested
1258
     address */
1259
  {
1260
    device_instance *memory = tree_find_ihandle_property(data->root, "/chosen/memory");
1261
    unsigned_cell mem_in[2];
1262
    mem_in[0] = args.size;
1263
    mem_in[1] = args.virt;
1264
    if (device_instance_call_method(memory, "release",
1265
                                    2, mem_in, 0, NULL) < 0)
1266
      error("chirp: claim failed to release memory virt=0x%lx size=%ld",
1267
            (unsigned long)args.virt,
1268
            (long int)args.size);
1269
  }
1270
  /* if using virtual addresses, remove the 1-1 map of this address space */
1271
  if (!data->real_mode) {
1272
    error("chirp: release method does not support virtual mode");
1273
  }
1274
  /* return the base address */
1275
  TRACE(trace_os_emul, ("release - out\n"));
1276
  chirp_write_h2t_args(&args,
1277
                       sizeof(args),
1278
                       data,
1279
                       processor, cia);
1280
  return 0;
1281
}
1282
 
1283
 
1284
/* Control transfer */
1285
 
1286
static int
1287
chirp_emul_boot(os_emul_data *data,
1288
                cpu *processor,
1289
                unsigned_word cia)
1290
{
1291
  /* unlike OpenFirmware this one can take an argument */
1292
  struct boot_args {
1293
    /*in*/
1294
    unsigned_cell bootspec;
1295
    /*out*/
1296
  } args;
1297
  char bootspec[1024];
1298
  /* read in the arguments */
1299
  if (chirp_read_t2h_args(&args, sizeof(args), -1, 0, data, processor, cia))
1300
    cpu_halt(processor, cia, was_exited, -1);
1301
  if (args.bootspec != 0)
1302
    emul_read_string(bootspec, args.bootspec, sizeof(bootspec),
1303
                     processor, cia);
1304
  else
1305
    strcpy(bootspec, "(null)");
1306
  TRACE(trace_os_emul, ("boot - in bootspec=`%s'\n", bootspec));
1307
  /* just report this and exit */
1308
  printf_filtered("chrp: boot %s called, exiting.\n", bootspec);
1309
  cpu_halt(processor, cia, was_exited, 0);
1310
  return 0;
1311
}
1312
 
1313
static int
1314
chirp_emul_enter(os_emul_data *data,
1315
                 cpu *processor,
1316
                 unsigned_word cia)
1317
{
1318
  error("chirp: enter method not implemented\n");
1319
  return 0;
1320
}
1321
 
1322
static int
1323
chirp_emul_exit(os_emul_data *data,
1324
                cpu *processor,
1325
                unsigned_word cia)
1326
{
1327
  /* unlike OpenBoot this one can take an argument */
1328
  struct exit_args {
1329
    /*in*/
1330
    signed_cell status;
1331
    /*out*/
1332
  } args;
1333
  if (chirp_read_t2h_args(&args, sizeof(args), -1, 0, data, processor, cia))
1334
    cpu_halt(processor, cia, was_exited, -1);
1335
  cpu_halt(processor, cia, was_exited, args.status);
1336
  return 0;
1337
}
1338
 
1339
static int
1340
chirp_emul_chain(os_emul_data *data,
1341
                 cpu *processor,
1342
                 unsigned_word cia)
1343
{
1344
  error("chirp: chain method not implemented\n");
1345
  return 0;
1346
}
1347
 
1348
 
1349
/* user interface */
1350
 
1351
static int
1352
chirp_emul_interpret(os_emul_data *data,
1353
                     cpu *processor,
1354
                     unsigned_word cia)
1355
{
1356
  error("chirp: interpret method not implemented\n");
1357
  return 0;
1358
}
1359
 
1360
static int
1361
chirp_emul_set_callback(os_emul_data *data,
1362
                        cpu *processor,
1363
                        unsigned_word cia)
1364
{
1365
  error("chirp: set_callback method not implemented\n");
1366
  return 0;
1367
}
1368
 
1369
static int
1370
chirp_emul_set_symbol_lookup(os_emul_data *data,
1371
                             cpu *processor,
1372
                             unsigned_word cia)
1373
{
1374
  error("chirp: set_symbol_lookup method not implemented\n");
1375
  return 0;
1376
}
1377
 
1378
 
1379
/* Time */
1380
 
1381
static int
1382
chirp_emul_milliseconds(os_emul_data *data,
1383
                        cpu *processor,
1384
                        unsigned_word cia)
1385
{
1386
  struct test_args {
1387
    /*in*/
1388
    /*out*/
1389
    unsigned_cell ms;
1390
  } args;
1391
  unsigned64 time;
1392
  /* read in the arguments */
1393
  if (chirp_read_t2h_args(&args, sizeof(args), 1, 1, data, processor, cia))
1394
    return -1;
1395
  /* make up a number */
1396
  time = event_queue_time(psim_event_queue(cpu_system(processor))) / 1000000;
1397
  args.ms = time;
1398
  /* write the arguments back out */
1399
  TRACE(trace_os_emul, ("milliseconds - out - ms=%ld\n",
1400
                        (unsigned long)args.ms));
1401
  chirp_write_h2t_args(&args,
1402
                       sizeof(args),
1403
                       data,
1404
                       processor, cia);
1405
  return 0;
1406
}
1407
 
1408
 
1409
 
1410
 
1411
static chirp_services services[] = {
1412
 
1413
  /* client interface */
1414
  { "test", chirp_emul_test },
1415
 
1416
  /* device tree */
1417
  { "peer", chirp_emul_peer },
1418
  { "child", chirp_emul_child },
1419
  { "parent", chirp_emul_parent },
1420
  { "instance-to-package", chirp_emul_instance_to_package },
1421
  { "getproplen", chirp_emul_getproplen },
1422
  { "getprop", chirp_emul_getprop },
1423
  { "nextprop", chirp_emul_nextprop },
1424
  /* { "setprop", chirp_emul_setprop }, */
1425
  { "canon", chirp_emul_canon },
1426
  { "finddevice", chirp_emul_finddevice },
1427
  { "instance-to-path", chirp_emul_instance_to_path },
1428
  { "package-to-path", chirp_emul_package_to_path },
1429
  { "call-method", chirp_emul_call_method },
1430
 
1431
  /* device I/O */
1432
  { "open", chirp_emul_open },
1433
  { "close", chirp_emul_close },
1434
  { "read", chirp_emul_read },
1435
  { "write", chirp_emul_write },
1436
  { "seek", chirp_emul_seek },
1437
  { "write", chirp_emul_write },
1438
 
1439
  /* memory */
1440
  { "claim", chirp_emul_claim },
1441
  { "release", chirp_emul_release },
1442
 
1443
  /* control transfer */
1444
  { "boot", chirp_emul_boot },
1445
  { "enter", chirp_emul_enter },
1446
  { "exit", chirp_emul_exit },
1447
  { "chain", chirp_emul_chain },
1448
 
1449
  /* user interface */
1450
  { "interpret", chirp_emul_interpret },
1451
  { "set_callback", chirp_emul_set_callback },
1452
  { "set_symbol_lookup", chirp_emul_set_symbol_lookup },
1453
 
1454
  /* time */
1455
  { "milliseconds", chirp_emul_milliseconds },
1456
 
1457
  { 0, /* sentinal */ },
1458
};
1459
 
1460
 
1461
/* main handlers */
1462
 
1463
/* Any starting address greater than this is assumed to be an Chirp
1464
   rather than VEA */
1465
 
1466
#ifndef CHIRP_START_ADDRESS
1467
#define CHIRP_START_ADDRESS 0x80000000
1468
#endif
1469
#ifndef CHIRP_LOAD_BASE
1470
#define CHIRP_LOAD_BASE -1
1471
#endif
1472
 
1473
 
1474
typedef struct _chirp_note_desc {
1475
  signed32 real_mode;
1476
  signed32 real_base;
1477
  signed32 real_size;
1478
  signed32 virt_base;
1479
  signed32 virt_size;
1480
  signed32 load_base;
1481
} chirp_note_desc;
1482
 
1483
typedef enum {
1484
  note_missing,
1485
  note_found,
1486
  note_correct,
1487
} note_found_status;
1488
typedef struct _chirp_note {
1489
  chirp_note_desc desc;
1490
  note_found_status found;
1491
} chirp_note;
1492
 
1493
typedef struct _chirp_note_head {
1494
  unsigned32 namesz;
1495
  unsigned32 descsz;
1496
  unsigned32 type;
1497
} chirp_note_head;
1498
 
1499
static void
1500
map_over_chirp_note(bfd *image,
1501
                    asection *sect,
1502
                    PTR obj)
1503
{
1504
  chirp_note *note = (chirp_note*)obj;
1505
  if (strcmp(sect->name, ".note") == 0) {
1506
    chirp_note_head head;
1507
    char name[16];
1508
    /* check the head */
1509
    if (!bfd_get_section_contents(image, sect,
1510
                                  &head, 0, sizeof(head)))
1511
      return;
1512
    head.namesz = bfd_get_32(image, (void*)&head.namesz);
1513
    head.descsz = bfd_get_32(image, (void*)&head.descsz);
1514
    head.type = bfd_get_32(image, (void*)&head.type);
1515
    if (head.type != 0x1275)
1516
      return;
1517
    /* check the name field */
1518
    if (head.namesz > sizeof(name)) {
1519
      error("chirp: note name too long (%d > %d)\n", (int)head.namesz, sizeof(name));
1520
    }
1521
    if (!bfd_get_section_contents(image, sect,
1522
                                  name, sizeof(head), head.namesz)) {
1523
      error("chirp: note name unreadable\n");
1524
    }
1525
    if (strcmp(name, "PowerPC") != 0) {
1526
      printf_filtered("chirp: note name (%s) not `PowerPC'\n", name);
1527
    }
1528
    /* check the size */
1529
    if (head.descsz == sizeof(note->desc) - sizeof(signed32)) {
1530
      sim_io_printf_filtered("chirp: note descriptor missing load-base\n");
1531
    }
1532
    else if (head.descsz != sizeof(note->desc)) {
1533
      sim_io_printf_filtered("chirp: note descriptor of wrong size\n");
1534
      note->found = note_found;
1535
      return;
1536
    }
1537
    note->found = note_correct;
1538
    /* get the contents */
1539
    if (!bfd_get_section_contents(image, sect,
1540
                                  &note->desc, /* page align start */
1541
                                  ((sizeof(head) + head.namesz) + 3) & ~3,
1542
                                  head.descsz)) {
1543
      error("chirp: note descriptor unreadable\n");
1544
    }
1545
    note->desc.real_mode = bfd_get_32(image, (void*)&note->desc.real_mode);
1546
    note->desc.real_base = bfd_get_32(image, (void*)&note->desc.real_base);
1547
    note->desc.real_size = bfd_get_32(image, (void*)&note->desc.real_size);
1548
    note->desc.virt_base = bfd_get_32(image, (void*)&note->desc.virt_base);
1549
    note->desc.virt_size = bfd_get_32(image, (void*)&note->desc.virt_size);
1550
    if (head.descsz == sizeof(note->desc))
1551
      note->desc.load_base = bfd_get_32(image, (void*)&note->desc.load_base);
1552
    else
1553
      note->desc.load_base = (signed32)-1;
1554
  }
1555
}
1556
 
1557
 
1558
static os_emul_data *
1559
emul_chirp_create(device *root,
1560
                  bfd *image,
1561
                  const char *name)
1562
{
1563
  os_emul_data *chirp;
1564
  device *node;
1565
  chirp_note note;
1566
  int i;
1567
 
1568
  /* Sanity check that this really is the chosen emulation */
1569
  if (name == NULL && image == NULL)
1570
    return NULL;
1571
  if (name != NULL
1572
      && strcmp(name, "ob") != 0
1573
      && strcmp(name, "ieee1274") != 0
1574
      && strcmp(name, "chrp") != 0
1575
      && strcmp(name, "chirp") != 0
1576
      && strcmp(name, "openboot") != 0)
1577
    return NULL;
1578
 
1579
  /* look for an elf note section, enter its values into the device tree */
1580
  memset(&note, 0, sizeof(note));
1581
  if (image != NULL)
1582
    bfd_map_over_sections(image, map_over_chirp_note, &note);
1583
  if (name == NULL && image != NULL && note.found == note_missing)
1584
    return NULL;
1585
 
1586
  /* Assume that it is a chirp emulation */
1587
 
1588
  chirp = ZALLOC(os_emul_data);
1589
  chirp->root = root;
1590
  chirp->services = services;
1591
 
1592
  /* the root node */
1593
  tree_parse(root, "/name \"gpl,clayton");
1594
 
1595
  /* default options */
1596
  emul_add_tree_options(root, image, "chirp", "oea",
1597
 
1598
 
1599
  /* hardware */
1600
  emul_add_tree_hardware(root);
1601
 
1602
  /* basic information */
1603
  chirp->memory_size
1604
    = tree_find_integer_property(root, "/openprom/options/oea-memory-size");
1605
  chirp->little_endian
1606
    = tree_find_boolean_property(root, "/options/little-endian?");
1607
  chirp->floating_point_available
1608
    = tree_find_boolean_property(root, "/openprom/options/floating-point?");
1609
  chirp->interrupt_prefix =
1610
    tree_find_integer_property(root, "/openprom/options/oea-interrupt-prefix");
1611
 
1612
 
1613
  /* Perform an interum layout of the openboot firmware in memory */
1614
 
1615
 
1616
  /* a page for firmware calls */
1617
  chirp->sizeof_code = 4096;
1618
  chirp->code_offset = 0x4000; /* possible space for interrupt table */
1619
 
1620
  /* the stack */
1621
  chirp->sizeof_stack = 32 * 1024;
1622
  chirp->stack_offset = chirp->code_offset + chirp->sizeof_code;
1623
 
1624
  /* the hash table */
1625
  if (!note.desc.real_mode) {
1626
    chirp->nr_page_table_entry_groups = (chirp->memory_size < 0x800000
1627
                                         ? 1024 /* min allowed */
1628
                                         : (chirp->memory_size / 4096 / 2));
1629
    chirp->sizeof_htab = chirp->nr_page_table_entry_groups * 64;
1630
  }
1631
  chirp->htab_offset = chirp->stack_offset + chirp->sizeof_stack;
1632
 
1633
  /* the actual amount of space needed */
1634
  chirp->real_size = chirp->htab_offset + chirp->sizeof_htab;
1635
 
1636
 
1637
  /* now go through and see if it fits in what is available */
1638
 
1639
 
1640
  /* resolve real-mode? */
1641
  if (note.found == note_correct)
1642
    chirp->real_mode = note.desc.real_mode;
1643
  else if (tree_find_property(root, "/options/real-mode?") != NULL)
1644
    chirp->real_mode = tree_find_boolean_property(root, "/options/real-mode?");
1645
  else
1646
    chirp->real_mode = 0;
1647
  if (tree_find_property(root, "/options/real-mode?") != NULL) {
1648
    if (!chirp->real_mode
1649
        != !tree_find_boolean_property(root, "/options/real-mode?"))
1650
      error("chirp: /options/real-mode? conflicts with note section\n");
1651
  }
1652
  else
1653
    tree_parse(root, "/options/real-mode? %s",
1654
               chirp->real_mode ? "true" : "false");
1655
 
1656
  /* resolve real-base */
1657
  if (note.found == note_correct
1658
      && note.desc.real_base != (signed32)-1)
1659
    chirp->real_base = note.desc.real_base;
1660
  else if (tree_find_property(root, "/options/real-base") != NULL)
1661
    chirp->real_base = tree_find_integer_property(root, "/options/real-base");
1662
  else
1663
    chirp->real_base = chirp->memory_size - chirp->real_size;
1664
  if (tree_find_property(root, "/options/real-base") != NULL) {
1665
    if (chirp->real_base != tree_find_integer_property(root, "/options/real-base"))
1666
      error("chirp: /options/real-base conflicts with note section\n");
1667
  }
1668
  else
1669
    tree_parse(root, "/options/real-base 0x%lx",
1670
               (unsigned long)chirp->real_base);
1671
 
1672
  /* resolve real-size */
1673
  if (note.found == note_correct
1674
      && note.desc.real_size != (signed32)-1
1675
      && note.desc.real_size != 0
1676
      && chirp->real_size > note.desc.real_size)
1677
    error("chirp: insufficient physical memory for firmware\n");
1678
  if (tree_find_property(root, "/options/real-size") != NULL) {
1679
    if (chirp->real_size > tree_find_integer_property(root, "/options/real-size"))
1680
      error("chirp: /options/real-size conflicts with note section\n");
1681
  }
1682
  else
1683
    tree_parse(root, "/options/real-size 0x%lx",
1684
               (unsigned long)chirp->real_size);
1685
 
1686
  /* resolve virt-base */
1687
  if (chirp->real_mode)
1688
    chirp->virt_base = chirp->real_base;
1689
  else if (note.found == note_correct && note.desc.virt_base != -1)
1690
    chirp->virt_base = note.desc.virt_base;
1691
  else if (tree_find_property(root, "/options/virt-base") != NULL)
1692
    chirp->virt_base = tree_find_integer_property(root, "/options/virt-base");
1693
  else
1694
    chirp->virt_base = CHIRP_START_ADDRESS;
1695
  if (tree_find_property(root, "/options/virt-base") != NULL) {
1696
    unsigned_word virt_base = tree_find_integer_property(root, "/options/virt-base");
1697
    if (virt_base != -1 && chirp->virt_base != virt_base)
1698
      error("chirp: /options/virt-base conflicts with note section\n");
1699
  }
1700
  else
1701
    tree_parse(root, "/options/virt-base 0x%lx",
1702
               chirp->real_mode ? -1 : (unsigned long)chirp->virt_base);
1703
 
1704
  /* resolve virt-size */
1705
  chirp->virt_size = chirp->real_size;
1706
  if (note.found == note_correct
1707
     && note.desc.virt_size != (signed32)-1
1708
      && note.desc.virt_size != 0
1709
      && !chirp->real_mode
1710
      && chirp->virt_size > note.desc.virt_size)
1711
    error("chirp: insufficent virtual memory for firmware\n");
1712
  if (tree_find_property(root, "/options/virt-size") != NULL) {
1713
    if (chirp->virt_size > tree_find_integer_property(root, "/options/virt-size"))
1714
      error("chirp: /options/virt-size conflicts with note section\n");
1715
  }
1716
  else
1717
    tree_parse(root, "/options/virt-size 0x%lx",
1718
               chirp->real_mode ? -1 : (unsigned long)chirp->virt_size);
1719
 
1720
  /* resolve load-base */
1721
  if (note.found == note_correct
1722
      && note.desc.load_base != (signed32)-1)
1723
    chirp->load_base = note.desc.load_base;
1724
  else if (tree_find_property(root, "/options/load-base") != NULL)
1725
    chirp->load_base = tree_find_integer_property(root, "/options/load-base");
1726
  else
1727
    chirp->load_base = CHIRP_LOAD_BASE;
1728
  if (tree_find_property(root, "/options/load-base") != NULL) {
1729
    if (chirp->load_base != tree_find_integer_property(root, "/options/load-base"))
1730
      error("chirp: /options/load-base conflicts with note section\n");
1731
  }
1732
  else
1733
    tree_parse(root, "/options/load-base 0x%lx",
1734
               (unsigned long)chirp->load_base);
1735
 
1736
  /* now adjust the preliminary firmware addresses to final values */
1737
  chirp->code_ra = chirp->code_offset + chirp->real_base;
1738
  chirp->stack_ra = chirp->stack_offset + chirp->real_base;
1739
  chirp->htab_ra = chirp->htab_offset + chirp->real_base;
1740
 
1741
  /* the virtual addresses.  In real mode these are real addresses. */
1742
 
1743
  chirp->code_va = chirp->code_offset + chirp->virt_base;
1744
  chirp->stack_va = chirp->stack_offset + chirp->virt_base;
1745
  chirp->htab_va = chirp->htab_offset + chirp->virt_base;
1746
 
1747
  chirp->code_client_va = chirp->code_va;
1748
  chirp->code_client_ra = chirp->code_ra;
1749
 
1750
  chirp->code_callback_va = chirp->code_client_va + 16;
1751
  chirp->code_callback_ra = chirp->code_client_ra + 16;
1752
 
1753
  chirp->code_loop_va = chirp->code_callback_va + 16;
1754
  chirp->code_loop_ra = chirp->code_callback_ra + 16;
1755
 
1756
  /* initialization */
1757
 
1758
  tree_parse(root, "/openprom/init");
1759
  tree_parse(root, "/openprom/init/register");
1760
  tree_parse(root, "/openprom/init/register/0.pc 0x%lx",
1761
             (unsigned long)bfd_get_start_address(image));
1762
  tree_parse(root, "/openprom/init/register/pc 0x%lx",
1763
             (unsigned long)chirp->code_loop_va);
1764
  tree_parse(root, "/openprom/init/register/msr 0x%x",
1765
             (msr_machine_check_enable
1766
              | (chirp->real_mode
1767
                 ? 0
1768
                 : (msr_instruction_relocate
1769
                    | msr_data_relocate))
1770
              | (chirp->little_endian
1771
                 ? (msr_little_endian_mode
1772
                    | msr_interrupt_little_endian_mode)
1773
                 : 0)
1774
              | (chirp->floating_point_available
1775
                 ? msr_floating_point_available
1776
                 : 0)
1777
              | (chirp->interrupt_prefix
1778
                 ? msr_interrupt_prefix
1779
                 : 0)
1780
              ));
1781
  tree_parse(root, "/openprom/init/register/sdr1 0x%lx",
1782
             (unsigned long)(chirp->htab_ra
1783
                             | MASK32(16, 22)
1784
                             | ((chirp->sizeof_htab - 1) >> 16)));
1785
  /* make certain that the segment registers map straight through */
1786
  for (i = 0; i < 16; i++) {
1787
    tree_parse(root, "/openprom/init/register/sr%d 0x%lx",
1788
               i, (unsigned long)i);
1789
  }
1790
 
1791
  /* establish an initial state for all processors */
1792
 
1793
 
1794
  /* the client interface address */
1795
  tree_parse(root, "/openprom/init/register/r5 0x%lx",
1796
             (unsigned long)chirp->code_client_va);
1797
  /* a stack */
1798
  tree_parse(root, "/openprom/init/register/sp 0x%lx",
1799
             (unsigned long)(chirp->stack_va + chirp->sizeof_stack - 16));
1800
  /* in chrp mode any arguments end up being concatinated */
1801
  tree_parse(root, "/openprom/init/stack/stack-type chirp");
1802
 
1803
 
1804
  /* client interface - emul-call followed by return instruction */
1805
 
1806
 
1807
  node = tree_parse(root, "/openprom/init/data@0x%lx",
1808
                    (unsigned long)chirp->code_client_ra);
1809
  tree_parse(node, "./psim,description \"client-interface instruction");
1810
  tree_parse(node, "./real-address 0x%lx",
1811
             (unsigned long)chirp->code_client_ra);
1812
  tree_parse(node, "./data 0x%lx",
1813
             (unsigned long)emul_call_instruction);
1814
 
1815
  node = tree_parse(root, "/openprom/init/data@0x%lx",
1816
                    (unsigned long)(chirp->code_client_ra + 4));
1817
  tree_parse(node, "./psim,description \"client-interface return instruction");
1818
  tree_parse(node, "./real-address 0x%lx",
1819
             (unsigned long)(chirp->code_client_ra + 4));
1820
  tree_parse(node, "./data 0x%lx",
1821
             (unsigned long)emul_blr_instruction);
1822
 
1823
 
1824
  /* return address for client callbacks - an emul-call instruction
1825
     that is again followed by a return instruction */
1826
 
1827
 
1828
  node = tree_parse(root, "/openprom/init/data@0x%lx",
1829
                    (unsigned long)chirp->code_callback_ra);
1830
  tree_parse(node, "./psim,description \"client-callback instruction");
1831
  tree_parse(node, "./real-address 0x%lx",
1832
             (unsigned long)chirp->code_callback_ra);
1833
  tree_parse(node, "./data 0x%lx",
1834
             (unsigned long)emul_call_instruction);
1835
 
1836
  node = tree_parse(root, "/openprom/init/data@0x%lx",
1837
                    (unsigned long)(chirp->code_callback_ra + 4));
1838
  tree_parse(node, "./psim,description \"client-callback return instruction");
1839
  tree_parse(node, "./real-address 0x%lx",
1840
             (unsigned long)(chirp->code_callback_ra + 4));
1841
  tree_parse(node, "./data 0x%lx",
1842
             (unsigned long)emul_blr_instruction);
1843
 
1844
  /* loop to keep other processors busy */
1845
 
1846
  node = tree_parse(root, "/openprom/init/data@0x%lx",
1847
                    (unsigned long)chirp->code_loop_ra);
1848
  tree_parse(node, "./psim,description \"processor busy loop");
1849
  tree_parse(node, "./real-address 0x%lx",
1850
             (unsigned long)chirp->code_loop_ra);
1851
  tree_parse(node, "./data 0x%lx",
1852
             (unsigned long)emul_loop_instruction);
1853
 
1854
  /* hash table */
1855
 
1856
  /* create a hash table */
1857
 
1858
  if (!chirp->real_mode) {
1859
    node = tree_parse(root, "/openprom/init/htab@0x%lx",
1860
                      (unsigned long)chirp->htab_ra);
1861
    tree_parse(node, "./claim 0");
1862
    tree_parse(node, "./real-address 0x%lx",
1863
               (unsigned long)chirp->htab_ra);
1864
    tree_parse(node, "./nr-bytes 0x%lx",
1865
               (unsigned long)chirp->sizeof_htab);
1866
  }
1867
 
1868
  /* map in the stack */
1869
 
1870
  if (!chirp->real_mode) {
1871
    node = tree_parse(root, "/openprom/init/htab/pte@0x%lx",
1872
                      (unsigned long)chirp->stack_ra);
1873
    tree_parse(node, "./psim,description \"map in the stack");
1874
    tree_parse(node, "./claim 1");
1875
    tree_parse(node, "./virtual-address 0x%lx",
1876
               (unsigned long)chirp->stack_va);
1877
    tree_parse(node, "./real-address 0x%lx",
1878
               (unsigned long)chirp->stack_ra);
1879
    tree_parse(node, "./nr-bytes 0x%lx",
1880
               (unsigned long)chirp->sizeof_stack);
1881
    tree_parse(node, "./wimg %d", 0x7);
1882
    tree_parse(node, "./pp %d", 0x2);
1883
  }
1884
 
1885
  /* map in the chrp openboot callback code */
1886
 
1887
  if (!chirp->real_mode) {
1888
    node = tree_parse(root, "/openprom/init/htab/pte@0x%lx",
1889
                      (unsigned long)chirp->code_ra);
1890
    tree_parse(node, "./psim,description \"map in chrp openboot callback code");
1891
    tree_parse(node, "./claim 1");
1892
    tree_parse(node, "./virtual-address 0x%lx",
1893
               (unsigned long)chirp->code_va);
1894
    tree_parse(node, "./real-address 0x%lx",
1895
               (unsigned long)chirp->code_ra);
1896
    tree_parse(node, "./nr-bytes 0x%lx",
1897
               (unsigned long)chirp->sizeof_code);
1898
    tree_parse(node, "./wimg %d", 0x7);
1899
    tree_parse(node, "./pp %d", 0x2);
1900
  }
1901
 
1902
  /* map in the program to run */
1903
 
1904
  if (chirp->real_mode) {
1905
    node = tree_parse(node, "/openprom/init/load-binary");
1906
    tree_parse(node, "./psim,description \"load the binary");
1907
    tree_parse(node, "./file-name %s", bfd_get_filename(image));
1908
    tree_parse(node, "./claim 1");
1909
  }
1910
  else {
1911
    node = tree_parse(root, "/openprom/init/htab/pte@0x%lx",
1912
                      (unsigned long)chirp->load_base);
1913
    tree_parse(node, "./psim,description \"load & map the binary");
1914
    tree_parse(node, "./claim 1");
1915
    tree_parse(node, "./file-name \"%s", bfd_get_filename(image));
1916
    tree_parse(node, "./wimg %d", 0x7);
1917
    tree_parse(node, "./pp %d", 0x2);
1918
  }
1919
 
1920
  /* map in the interrupt vectors */
1921
 
1922
  if (!chirp->real_mode) {
1923
    node = tree_parse(root, "/openprom/init/htab/pte@0x0");
1924
    tree_parse(node, "./psim,description \"map in interrupt vectors");
1925
    tree_parse(node, "./virtual-address 0x0");
1926
    tree_parse(node, "./real-address 0x0");
1927
    tree_parse(node, "./nr-bytes 0x3000");
1928
    tree_parse(node, "./wimg %d", 0x7);
1929
    tree_parse(node, "./pp %d", 0x2);
1930
  }
1931
 
1932
  return chirp;
1933
}
1934
 
1935
static void
1936
emul_chirp_init(os_emul_data *emul_data,
1937
                int nr_cpus)
1938
{
1939
  emul_data->state = serving;
1940
}
1941
 
1942
static int
1943
emul_chirp_instruction_call(cpu *processor,
1944
                            unsigned_word cia,
1945
                            unsigned_word ra,
1946
                            os_emul_data *emul_data)
1947
{
1948
  unsigned_word service_name_addr;
1949
  unsigned_word result;
1950
  char service_buf[32];
1951
  char *service_name;
1952
  chirp_services *service;
1953
 
1954
  switch (emul_data->state) {
1955
 
1956
  case serving:
1957
    /* we are waiting on an OpenBoot request from the client program
1958
       via the client interface */
1959
    if (cia != emul_data->code_client_va)
1960
      return 0;
1961
    emul_data->return_address = LR;
1962
    emul_data->arguments = cpu_registers(processor)->gpr[3];
1963
    /* try to determine what to do */
1964
    service_name_addr = emul_read_word(cpu_registers(processor)->gpr[3],
1965
                                       processor, cia);
1966
    service_name = emul_read_string(service_buf, service_name_addr,
1967
                                    sizeof(service_buf), processor, cia);
1968
    emul_data->n_args = emul_read_word(emul_data->arguments + sizeof(unsigned_cell),
1969
                                       processor, cia);
1970
    emul_data->n_returns = emul_read_word(emul_data->arguments + 2 * sizeof(unsigned_cell),
1971
                                          processor, cia);
1972
    /* verify what was passed */
1973
    if (service_name_addr == 0
1974
        || service_name == NULL) {
1975
      error("OpenFirmware called with invalid (NULL) service name from 0x%lx with args 0x%lx\n",
1976
            (unsigned long)emul_data->return_address,
1977
            (unsigned long)emul_data->arguments);
1978
    }
1979
    if (emul_data->n_args > 6) { /* See iee1275 requirements on nr returns */
1980
      error("OpenFirmware service %s called from 0x%lx with args 0x%lx, too many args (%d)\n",
1981
            (unsigned long)emul_data->return_address,
1982
            (unsigned long)emul_data->arguments,
1983
            emul_data->n_returns);
1984
    }
1985
    if (emul_data->n_returns > 6) {
1986
      error("OpenFirmware service %s called from 0x%lx with args 0x%lx,  with too many returns (%d)\n",
1987
            (unsigned long)emul_data->return_address,
1988
            (unsigned long)emul_data->arguments,
1989
            emul_data->n_args);
1990
    }
1991
    /* look it up */
1992
    TRACE(trace_os_emul, ("%s called from 0x%lx with args 0x%lx\n",
1993
                          service_name,
1994
                          (unsigned long)emul_data->return_address,
1995
                          (unsigned long)emul_data->arguments));
1996
    service = services;
1997
    while (service->name != NULL && strcmp(service->name, service_name) != 0)
1998
      service++;
1999
    /* found or not? */
2000
    if (service->name == NULL) {
2001
      error("OpenBoot service `%s' not found\n", service_name);
2002
      TRACE(trace_os_emul, ("%s not found\n", service_name));
2003
      cpu_registers(processor)->gpr[3] = -1;
2004
    }
2005
    else {
2006
      emul_data->service = service;
2007
      /* call upon it */
2008
      result = service->handler(emul_data, processor, cia);
2009
      if (result != 0)
2010
        TRACE(trace_os_emul, ("%s aborted with %ld\n", service_name, (long)result));
2011
      cpu_registers(processor)->gpr[3] = result;
2012
    }
2013
    break;
2014
 
2015
  default:
2016
    error("emul_chirp_instruction_call() unknown internal state\n");
2017
    result = -1;
2018
    break;
2019
 
2020
  }
2021
 
2022
  /* return to caller - instruction following this is a function return */
2023
  return 1;
2024
}
2025
 
2026
const os_emul emul_chirp = {
2027
  "chirp",
2028
  emul_chirp_create,
2029
  emul_chirp_init,
2030
  NULL, /*system_call*/
2031
  emul_chirp_instruction_call,
2032
 
2033
};
2034
 
2035
#endif

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.