* sim-profile.c (profile_print): Delete duplicate test of
[deliverable/binutils-gdb.git] / sim / common / sim-core.c
CommitLineData
f2de7dfd
AC
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 _SIM_CORE_C_
23#define _SIM_CORE_C_
24
c967f187
DE
25#include "sim-main.h"
26#include "sim-assert.h"
f2de7dfd 27
c967f187 28/* "core" module install handler.
cd0d873d 29
c967f187
DE
30 This is called via sim_module_install to install the "core" subsystem
31 into the simulator. */
32
cd0d873d
AC
33static MODULE_INIT_FN sim_core_init;
34static MODULE_UNINSTALL_FN sim_core_uninstall;
35
d147d384
AC
36#if (WITH_DEVICES)
37/* TODO: create sim/common/device.h */
38void device_error (device *me, char* message, ...);
39int device_io_read_buffer(device *me, void *dest, int space, address_word addr, unsigned nr_bytes, sim_cpu *processor, sim_cia cia);
40int device_io_write_buffer(device *me, const void *source, int space, address_word addr, unsigned nr_bytes, sim_cpu *processor, sim_cia cia);
41#endif
42
c967f187
DE
43EXTERN_SIM_CORE\
44(SIM_RC)
45sim_core_install (SIM_DESC sd)
46{
50a2a691 47 SIM_ASSERT (STATE_MAGIC (sd) == SIM_MAGIC_NUMBER);
a34abff8
AC
48
49 /* establish the other handlers */
c967f187
DE
50 sim_module_add_uninstall_fn (sd, sim_core_uninstall);
51 sim_module_add_init_fn (sd, sim_core_init);
a34abff8
AC
52
53 /* establish any initial data structures - none */
c967f187
DE
54 return SIM_RC_OK;
55}
56
57
58/* Uninstall the "core" subsystem from the simulator. */
59
cd0d873d 60STATIC_SIM_CORE\
f2de7dfd 61(void)
c967f187 62sim_core_uninstall (SIM_DESC sd)
f2de7dfd 63{
f90b720b 64 sim_core *core = STATE_CORE(sd);
c967f187 65 sim_core_maps map;
a34abff8 66 /* blow away any mappings */
f90b720b 67 for (map = 0; map < nr_sim_core_maps; map++) {
f90b720b 68 sim_core_mapping *curr = core->common.map[map].first;
f2de7dfd 69 while (curr != NULL) {
c967f187 70 sim_core_mapping *tbd = curr;
f2de7dfd 71 curr = curr->next;
fd89abc2 72 if (tbd->free_buffer != NULL) {
c967f187 73 SIM_ASSERT(tbd->buffer != NULL);
fd89abc2 74 zfree(tbd->free_buffer);
f2de7dfd
AC
75 }
76 zfree(tbd);
77 }
f90b720b
AC
78 core->common.map[map].first = NULL;
79 }
a34abff8
AC
80}
81
82
83STATIC_SIM_CORE\
84(SIM_RC)
85sim_core_init (SIM_DESC sd)
86{
87 /* Nothing to do */
c967f187 88 return SIM_RC_OK;
f2de7dfd
AC
89}
90
91
92
50a2a691
AC
93#ifndef SIM_CORE_SIGNAL
94#define SIM_CORE_SIGNAL(SD,CPU,CIA,MAP,NR_BYTES,ADDR,TRANSFER,ERROR) \
95sim_core_signal ((SD), (CPU), (CIA), (MAP), (NR_BYTES), (ADDR), (TRANSFER), (ERROR))
96
cd0d873d
AC
97STATIC_SIM_CORE\
98(void)
50a2a691
AC
99sim_core_signal (SIM_DESC sd,
100 sim_cpu *cpu,
101 sim_cia cia,
102 sim_core_maps map,
103 int nr_bytes,
104 address_word addr,
105 transfer_type transfer,
106 sim_core_signals sig)
107{
108 const char *copy = (transfer == read_transfer ? "read" : "write");
340d8e20 109 address_word ip = CIA_ADDR (cia);
50a2a691
AC
110 switch (sig)
111 {
112 case sim_core_unmapped_signal:
d147d384 113 sim_io_eprintf (sd, "core: %d byte %s to unmapped address 0x%lx at 0x%lx\n",
cf02c13c 114 nr_bytes, copy, (unsigned long) addr, (unsigned long) ip);
a4b44a2b 115 sim_engine_halt (sd, cpu, NULL, cia, sim_stopped, SIM_SIGSEGV);
50a2a691
AC
116 break;
117 case sim_core_unaligned_signal:
cf02c13c
DE
118 sim_io_eprintf (sd, "core: %d byte misaligned %s to address 0x%lx at 0x%lx\n",
119 nr_bytes, copy, (unsigned long) addr, (unsigned long) ip);
a4b44a2b 120 sim_engine_halt (sd, cpu, NULL, cia, sim_stopped, SIM_SIGBUS);
50a2a691
AC
121 break;
122 default:
fd89abc2
AC
123 sim_engine_abort (sd, cpu, cia,
124 "sim_core_signal - internal error - bad switch");
50a2a691
AC
125 }
126}
50a2a691
AC
127#endif
128
cd0d873d 129
1fe05280
AC
130STATIC_INLINE_SIM_CORE\
131(const char *)
132sim_core_map_to_str (sim_core_maps map)
133{
134 switch (map)
135 {
136 case sim_core_read_map: return "read";
137 case sim_core_write_map: return "write";
138 case sim_core_execute_map: return "exec";
139 default: return "(invalid-map)";
140 }
141}
142
143
cd0d873d 144STATIC_SIM_CORE\
c967f187 145(sim_core_mapping *)
a34abff8 146new_sim_core_mapping (SIM_DESC sd,
fcc86d82 147 int level,
a34abff8
AC
148 int space,
149 address_word addr,
150 address_word nr_bytes,
151 unsigned modulo,
152 device *device,
153 void *buffer,
fd89abc2 154 void *free_buffer)
f2de7dfd 155{
c967f187 156 sim_core_mapping *new_mapping = ZALLOC(sim_core_mapping);
f2de7dfd 157 /* common */
fcc86d82 158 new_mapping->level = level;
f2de7dfd
AC
159 new_mapping->space = space;
160 new_mapping->base = addr;
161 new_mapping->nr_bytes = nr_bytes;
162 new_mapping->bound = addr + (nr_bytes - 1);
a34abff8
AC
163 if (modulo == 0)
164 new_mapping->mask = (unsigned) 0 - 1;
165 else
166 new_mapping->mask = modulo - 1;
fcc86d82
AC
167 new_mapping->buffer = buffer;
168 new_mapping->free_buffer = free_buffer;
169 new_mapping->device = device;
f2de7dfd
AC
170 return new_mapping;
171}
172
173
cd0d873d 174STATIC_SIM_CORE\
f2de7dfd 175(void)
a34abff8
AC
176sim_core_map_attach (SIM_DESC sd,
177 sim_core_map *access_map,
fcc86d82 178 int level,
a34abff8
AC
179 int space,
180 address_word addr,
181 address_word nr_bytes,
182 unsigned modulo,
183 device *client, /*callback/default*/
184 void *buffer, /*raw_memory*/
fd89abc2 185 void *free_buffer) /*raw_memory*/
f2de7dfd
AC
186{
187 /* find the insertion point for this additional mapping and then
188 insert */
c967f187
DE
189 sim_core_mapping *next_mapping;
190 sim_core_mapping **last_mapping;
f2de7dfd 191
fcc86d82
AC
192 SIM_ASSERT ((client == NULL) != (buffer == NULL));
193 SIM_ASSERT ((client == NULL) >= (free_buffer != NULL));
f2de7dfd
AC
194
195 /* actually do occasionally get a zero size map */
a34abff8
AC
196 if (nr_bytes == 0)
197 {
f2de7dfd 198#if (WITH_DEVICES)
a34abff8 199 device_error(client, "called on sim_core_map_attach with size zero");
f2de7dfd 200#else
a34abff8 201 sim_io_error (sd, "called on sim_core_map_attach with size zero");
f2de7dfd 202#endif
a34abff8 203 }
f2de7dfd
AC
204
205 /* find the insertion point (between last/next) */
206 next_mapping = access_map->first;
207 last_mapping = &access_map->first;
208 while(next_mapping != NULL
fcc86d82
AC
209 && (next_mapping->level < level
210 || (next_mapping->level == level
a34abff8
AC
211 && next_mapping->bound < addr)))
212 {
213 /* provided levels are the same */
214 /* assert: next_mapping->base > all bases before next_mapping */
215 /* assert: next_mapping->bound >= all bounds before next_mapping */
216 last_mapping = &next_mapping->next;
217 next_mapping = next_mapping->next;
218 }
219
f2de7dfd 220 /* check insertion point correct */
fcc86d82
AC
221 SIM_ASSERT (next_mapping == NULL || next_mapping->level >= level);
222 if (next_mapping != NULL && next_mapping->level == level
80c651f0
AC
223 && next_mapping->base < (addr + (nr_bytes - 1)))
224 {
f2de7dfd 225#if (WITH_DEVICES)
80c651f0
AC
226 device_error (client, "memory map %d:0x%lx..0x%lx (%ld bytes) overlaps %d:0x%lx..0x%lx (%ld bytes)",
227 space,
228 (long) addr,
229 (long) nr_bytes,
230 (long) (addr + (nr_bytes - 1)),
231 next_mapping->space,
232 (long) next_mapping->base,
233 (long) next_mapping->bound,
234 (long) next_mapping->nr_bytes);
f2de7dfd 235#else
80c651f0
AC
236 sim_io_error (sd, "memory map %d:0x%lx..0x%lx (%ld bytes) overlaps %d:0x%lx..0x%lx (%ld bytes)",
237 space,
238 (long) addr,
239 (long) nr_bytes,
240 (long) (addr + (nr_bytes - 1)),
241 next_mapping->space,
242 (long) next_mapping->base,
243 (long) next_mapping->bound,
244 (long) next_mapping->nr_bytes);
f2de7dfd
AC
245#endif
246 }
247
248 /* create/insert the new mapping */
c967f187 249 *last_mapping = new_sim_core_mapping(sd,
fcc86d82 250 level,
a34abff8 251 space, addr, nr_bytes, modulo,
80c651f0 252 client, buffer, free_buffer);
f2de7dfd
AC
253 (*last_mapping)->next = next_mapping;
254}
255
256
cd0d873d 257EXTERN_SIM_CORE\
f2de7dfd 258(void)
a34abff8
AC
259sim_core_attach (SIM_DESC sd,
260 sim_cpu *cpu,
fcc86d82 261 int level,
a34abff8
AC
262 access_type access,
263 int space,
264 address_word addr,
265 address_word nr_bytes,
266 unsigned modulo,
267 device *client,
268 void *optional_buffer)
f2de7dfd 269{
1fe05280 270 sim_core *memory = STATE_CORE(sd);
c967f187 271 sim_core_maps map;
f2de7dfd 272 void *buffer;
fd89abc2 273 void *free_buffer;
7a418800
AC
274
275 /* check for for attempt to use unimplemented per-processor core map */
276 if (cpu != NULL)
277 sim_io_error (sd, "sim_core_map_attach - processor specific memory map not yet supported");
278
f2de7dfd 279 if ((access & access_read_write_exec) == 0
a34abff8
AC
280 || (access & ~access_read_write_exec) != 0)
281 {
f2de7dfd 282#if (WITH_DEVICES)
a34abff8 283 device_error(client, "invalid access for core attach");
f2de7dfd 284#else
a34abff8 285 sim_io_error (sd, "invalid access for core attach");
f2de7dfd 286#endif
a34abff8
AC
287 }
288
fcc86d82
AC
289 /* verify modulo memory */
290 if (!WITH_MODULO_MEMORY && modulo != 0)
291 {
292#if (WITH_DEVICES)
293 device_error (client, "sim_core_attach - internal error - modulo memory disabled");
294#else
295 sim_io_error (sd, "sim_core_attach - internal error - modulo memory disabled");
296#endif
297 }
298 if (client != NULL && modulo != 0)
a34abff8 299 {
a34abff8 300#if (WITH_DEVICES)
fcc86d82 301 device_error (client, "sim_core_attach - internal error - modulo and callback memory conflict");
a34abff8 302#else
fcc86d82 303 sim_io_error (sd, "sim_core_attach - internal error - modulo and callback memory conflict");
a34abff8 304#endif
fcc86d82
AC
305 }
306 if (modulo != 0)
307 {
308 unsigned mask = modulo - 1;
309 /* any zero bits */
310 while (mask >= sizeof (unsigned64)) /* minimum modulo */
311 {
312 if ((mask & 1) == 0)
313 mask = 0;
314 else
315 mask >>= 1;
a34abff8 316 }
fcc86d82 317 if (mask != sizeof (unsigned64) - 1)
a34abff8
AC
318 {
319#if (WITH_DEVICES)
fcc86d82 320 device_error (client, "sim_core_attach - internal error - modulo %lx not power of two", (long) modulo);
a34abff8 321#else
fcc86d82 322 sim_io_error (sd, "sim_core_attach - internal error - modulo %lx not power of two", (long) modulo);
a34abff8
AC
323#endif
324 }
fcc86d82
AC
325 }
326
327 /* verify consistency between device and buffer */
328 if (client != NULL && optional_buffer != NULL)
329 {
330#if (WITH_DEVICES)
331 device_error (client, "sim_core_attach - internal error - conflicting buffer and attach arguments");
332#else
333 sim_io_error (sd, "sim_core_attach - internal error - conflicting buffer and attach arguments");
334#endif
335 }
336 if (client == NULL)
337 {
a34abff8
AC
338 if (optional_buffer == NULL)
339 {
fd89abc2
AC
340 int padding = (addr % sizeof (unsigned64));
341 free_buffer = zalloc ((modulo == 0 ? nr_bytes : modulo) + padding);
342 buffer = (char*) free_buffer + padding;
a34abff8
AC
343 }
344 else
345 {
346 buffer = optional_buffer;
fd89abc2 347 free_buffer = NULL;
a34abff8 348 }
f2de7dfd 349 }
a34abff8
AC
350 else
351 {
fcc86d82 352 /* a device */
a34abff8 353 buffer = NULL;
fd89abc2 354 free_buffer = NULL;
a34abff8
AC
355 }
356
f2de7dfd
AC
357 /* attach the region to all applicable access maps */
358 for (map = 0;
c967f187 359 map < nr_sim_core_maps;
a34abff8
AC
360 map++)
361 {
362 switch (map)
363 {
364 case sim_core_read_map:
365 if (access & access_read)
366 sim_core_map_attach (sd, &memory->common.map[map],
fcc86d82 367 level, space, addr, nr_bytes, modulo,
fd89abc2
AC
368 client, buffer, free_buffer);
369 free_buffer = NULL;
a34abff8
AC
370 break;
371 case sim_core_write_map:
372 if (access & access_write)
373 sim_core_map_attach (sd, &memory->common.map[map],
fcc86d82 374 level, space, addr, nr_bytes, modulo,
fd89abc2
AC
375 client, buffer, free_buffer);
376 free_buffer = NULL;
a34abff8
AC
377 break;
378 case sim_core_execute_map:
379 if (access & access_exec)
380 sim_core_map_attach (sd, &memory->common.map[map],
fcc86d82 381 level, space, addr, nr_bytes, modulo,
fd89abc2
AC
382 client, buffer, free_buffer);
383 free_buffer = NULL;
a34abff8
AC
384 break;
385 case nr_sim_core_maps:
386 sim_io_error (sd, "sim_core_attach - internal error - bad switch");
387 break;
388 }
f2de7dfd 389 }
a34abff8 390
7a418800
AC
391 /* Just copy this map to each of the processor specific data structures.
392 FIXME - later this will be replaced by true processor specific
393 maps. */
f90b720b
AC
394 {
395 int i;
396 for (i = 0; i < MAX_NR_PROCESSORS; i++)
397 {
398 CPU_CORE (STATE_CPU (sd, i))->common = STATE_CORE (sd)->common;
399 }
400 }
f2de7dfd
AC
401}
402
403
a34abff8
AC
404/* Remove any memory reference related to this address */
405STATIC_INLINE_SIM_CORE\
406(void)
407sim_core_map_detach (SIM_DESC sd,
408 sim_core_map *access_map,
fcc86d82 409 int level,
a34abff8
AC
410 int space,
411 address_word addr)
412{
413 sim_core_mapping **entry;
414 for (entry = &access_map->first;
415 (*entry) != NULL;
416 entry = &(*entry)->next)
417 {
418 if ((*entry)->base == addr
fcc86d82 419 && (*entry)->level == level
a34abff8
AC
420 && (*entry)->space == space)
421 {
422 sim_core_mapping *dead = (*entry);
423 (*entry) = dead->next;
fd89abc2
AC
424 if (dead->free_buffer != NULL)
425 zfree (dead->free_buffer);
a34abff8
AC
426 zfree (dead);
427 return;
428 }
429 }
430}
431
432EXTERN_SIM_CORE\
433(void)
434sim_core_detach (SIM_DESC sd,
435 sim_cpu *cpu,
fcc86d82 436 int level,
a34abff8
AC
437 int address_space,
438 address_word addr)
439{
440 sim_core *memory = STATE_CORE (sd);
441 sim_core_maps map;
442 for (map = 0; map < nr_sim_core_maps; map++)
443 {
444 sim_core_map_detach (sd, &memory->common.map[map],
fcc86d82 445 level, address_space, addr);
a34abff8
AC
446 }
447 /* Just copy this update to each of the processor specific data
448 structures. FIXME - later this will be replaced by true
449 processor specific maps. */
450 {
451 int i;
452 for (i = 0; i < MAX_NR_PROCESSORS; i++)
453 {
454 CPU_CORE (STATE_CPU (sd, i))->common = STATE_CORE (sd)->common;
455 }
456 }
457}
458
459
f2de7dfd 460STATIC_INLINE_SIM_CORE\
c967f187 461(sim_core_mapping *)
f90b720b 462sim_core_find_mapping(sim_core_common *core,
c967f187 463 sim_core_maps map,
cd0d873d 464 address_word addr,
f2de7dfd 465 unsigned nr_bytes,
50a2a691 466 transfer_type transfer,
7a418800
AC
467 int abort, /*either 0 or 1 - hint to inline/-O */
468 sim_cpu *cpu, /* abort => cpu != NULL */
1fe05280 469 sim_cia cia)
f2de7dfd 470{
7a418800
AC
471 sim_core_mapping *mapping = core->map[map].first;
472 ASSERT ((addr & (nr_bytes - 1)) == 0); /* must be aligned */
473 ASSERT ((addr + (nr_bytes - 1)) >= addr); /* must not wrap */
474 ASSERT (!abort || cpu != NULL); /* abort needs a non null CPU */
475 while (mapping != NULL)
476 {
477 if (addr >= mapping->base
478 && (addr + (nr_bytes - 1)) <= mapping->bound)
479 return mapping;
480 mapping = mapping->next;
481 }
f2de7dfd 482 if (abort)
7a418800 483 {
50a2a691
AC
484 SIM_CORE_SIGNAL (CPU_STATE (cpu), cpu, cia, map, nr_bytes, addr, transfer,
485 sim_core_unmapped_signal);
7a418800 486 }
f2de7dfd
AC
487 return NULL;
488}
489
490
491STATIC_INLINE_SIM_CORE\
492(void *)
f90b720b
AC
493sim_core_translate (sim_core_mapping *mapping,
494 address_word addr)
f2de7dfd 495{
a34abff8
AC
496 if (WITH_MODULO_MEMORY)
497 return (void *)((unsigned8 *) mapping->buffer
498 + ((addr - mapping->base) & mapping->mask));
499 else
500 return (void *)((unsigned8 *) mapping->buffer
501 + addr - mapping->base);
f2de7dfd
AC
502}
503
504
cd0d873d 505EXTERN_SIM_CORE\
f2de7dfd 506(unsigned)
f90b720b
AC
507sim_core_read_buffer (SIM_DESC sd,
508 sim_cpu *cpu,
509 sim_core_maps map,
510 void *buffer,
511 address_word addr,
512 unsigned len)
f2de7dfd 513{
f90b720b 514 sim_core_common *core = (cpu == NULL ? &STATE_CORE (sd)->common : &CPU_CORE (cpu)->common);
f2de7dfd
AC
515 unsigned count = 0;
516 while (count < len) {
517 unsigned_word raddr = addr + count;
c967f187 518 sim_core_mapping *mapping =
f90b720b 519 sim_core_find_mapping(core, map,
50a2a691
AC
520 raddr, /*nr-bytes*/1,
521 read_transfer,
f90b720b 522 0 /*dont-abort*/, NULL, NULL_CIA);
f2de7dfd
AC
523 if (mapping == NULL)
524 break;
525#if (WITH_DEVICES)
526 if (mapping->device != NULL) {
527 int nr_bytes = len - count;
528 if (raddr + nr_bytes - 1> mapping->bound)
529 nr_bytes = mapping->bound - raddr + 1;
530 if (device_io_read_buffer(mapping->device,
531 (unsigned_1*)buffer + count,
532 mapping->space,
533 raddr,
d147d384
AC
534 nr_bytes,
535 cpu,
536 CIA_GET(cpu)) != nr_bytes)
f2de7dfd
AC
537 break;
538 count += nr_bytes;
539 }
540 else
541#endif
542 {
543 ((unsigned_1*)buffer)[count] =
c967f187 544 *(unsigned_1*)sim_core_translate(mapping, raddr);
f2de7dfd
AC
545 count += 1;
546 }
547 }
548 return count;
549}
550
551
cd0d873d 552EXTERN_SIM_CORE\
f2de7dfd 553(unsigned)
f90b720b
AC
554sim_core_write_buffer (SIM_DESC sd,
555 sim_cpu *cpu,
556 sim_core_maps map,
557 const void *buffer,
558 address_word addr,
559 unsigned len)
f2de7dfd 560{
f90b720b 561 sim_core_common *core = (cpu == NULL ? &STATE_CORE (sd)->common : &CPU_CORE (cpu)->common);
f2de7dfd
AC
562 unsigned count = 0;
563 while (count < len) {
564 unsigned_word raddr = addr + count;
f90b720b
AC
565 sim_core_mapping *mapping =
566 sim_core_find_mapping(core, map,
567 raddr, /*nr-bytes*/1,
568 write_transfer,
569 0 /*dont-abort*/, NULL, NULL_CIA);
f2de7dfd
AC
570 if (mapping == NULL)
571 break;
572#if (WITH_DEVICES)
573 if (WITH_CALLBACK_MEMORY
574 && mapping->device != NULL) {
575 int nr_bytes = len - count;
576 if (raddr + nr_bytes - 1 > mapping->bound)
577 nr_bytes = mapping->bound - raddr + 1;
578 if (device_io_write_buffer(mapping->device,
579 (unsigned_1*)buffer + count,
580 mapping->space,
581 raddr,
d147d384
AC
582 nr_bytes,
583 cpu,
584 CIA_GET(cpu)) != nr_bytes)
f2de7dfd
AC
585 break;
586 count += nr_bytes;
587 }
588 else
589#endif
590 {
c967f187 591 *(unsigned_1*)sim_core_translate(mapping, raddr) =
f2de7dfd
AC
592 ((unsigned_1*)buffer)[count];
593 count += 1;
594 }
595 }
596 return count;
597}
598
599
cd0d873d
AC
600EXTERN_SIM_CORE\
601(void)
f90b720b
AC
602sim_core_set_xor (SIM_DESC sd,
603 sim_cpu *cpu,
cd0d873d
AC
604 int is_xor)
605{
f90b720b 606 /* set up the XOR map if required. */
cd0d873d
AC
607 if (WITH_XOR_ENDIAN) {
608 {
f90b720b
AC
609 sim_core *core = STATE_CORE (sd);
610 sim_cpu_core *cpu_core = (cpu != NULL ? CPU_CORE (cpu) : NULL);
611 if (cpu_core != NULL)
cd0d873d 612 {
f90b720b
AC
613 int i = 1;
614 unsigned mask;
615 if (is_xor)
616 mask = WITH_XOR_ENDIAN - 1;
617 else
618 mask = 0;
619 while (i - 1 < WITH_XOR_ENDIAN)
620 {
621 cpu_core->xor[i-1] = mask;
622 mask = (mask << 1) & (WITH_XOR_ENDIAN - 1);
623 i = (i << 1);
624 }
cd0d873d 625 }
f90b720b
AC
626 else
627 {
628 if (is_xor)
629 core->byte_xor = WITH_XOR_ENDIAN - 1;
630 else
631 core->byte_xor = 0;
632 }
cd0d873d
AC
633 }
634 }
635 else {
636 if (is_xor)
f90b720b 637 sim_engine_abort (sd, cpu, NULL_CIA,
cd0d873d
AC
638 "Attempted to enable xor-endian mode when permenantly disabled.");
639 }
640}
641
f90b720b
AC
642STATIC_INLINE_SIM_CORE\
643(void)
644reverse_n (unsigned_1 *dest,
645 const unsigned_1 *src,
646 int nr_bytes)
647{
648 int i;
649 for (i = 0; i < nr_bytes; i++)
650 {
651 dest [nr_bytes - i - 1] = src [i];
652 }
653}
654
655
656EXTERN_SIM_CORE\
657(unsigned)
658sim_core_xor_read_buffer (SIM_DESC sd,
659 sim_cpu *cpu,
660 sim_core_maps map,
661 void *buffer,
662 address_word addr,
663 unsigned nr_bytes)
664{
665 address_word byte_xor = (cpu == NULL ? STATE_CORE (sd)->byte_xor : CPU_CORE (cpu)->xor[0]);
666 if (!WITH_XOR_ENDIAN || !byte_xor)
667 return sim_core_read_buffer (sd, cpu, map, buffer, addr, nr_bytes);
668 else
669 /* only break up transfers when xor-endian is both selected and enabled */
670 {
31dda65a 671 unsigned_1 x[WITH_XOR_ENDIAN + 1]; /* +1 to avoid zero-sized array */
f90b720b
AC
672 unsigned nr_transfered = 0;
673 address_word start = addr;
674 unsigned nr_this_transfer = (WITH_XOR_ENDIAN - (addr & ~(WITH_XOR_ENDIAN - 1)));
675 address_word stop;
676 /* initial and intermediate transfers are broken when they cross
677 an XOR endian boundary */
678 while (nr_transfered + nr_this_transfer < nr_bytes)
679 /* initial/intermediate transfers */
680 {
681 /* since xor-endian is enabled stop^xor defines the start
682 address of the transfer */
683 stop = start + nr_this_transfer - 1;
684 SIM_ASSERT (start <= stop);
685 SIM_ASSERT ((stop ^ byte_xor) <= (start ^ byte_xor));
686 if (sim_core_read_buffer (sd, cpu, map, x, stop ^ byte_xor, nr_this_transfer)
687 != nr_this_transfer)
688 return nr_transfered;
689 reverse_n (&((unsigned_1*)buffer)[nr_transfered], x, nr_this_transfer);
690 nr_transfered += nr_this_transfer;
691 nr_this_transfer = WITH_XOR_ENDIAN;
692 start = stop + 1;
693 }
694 /* final transfer */
695 nr_this_transfer = nr_bytes - nr_transfered;
696 stop = start + nr_this_transfer - 1;
697 SIM_ASSERT (stop == (addr + nr_bytes - 1));
698 if (sim_core_read_buffer (sd, cpu, map, x, stop ^ byte_xor, nr_this_transfer)
699 != nr_this_transfer)
700 return nr_transfered;
701 reverse_n (&((unsigned_1*)buffer)[nr_transfered], x, nr_this_transfer);
702 return nr_bytes;
703 }
704}
705
706
707EXTERN_SIM_CORE\
708(unsigned)
709sim_core_xor_write_buffer (SIM_DESC sd,
710 sim_cpu *cpu,
711 sim_core_maps map,
712 const void *buffer,
713 address_word addr,
714 unsigned nr_bytes)
715{
716 address_word byte_xor = (cpu == NULL ? STATE_CORE (sd)->byte_xor : CPU_CORE (cpu)->xor[0]);
717 if (!WITH_XOR_ENDIAN || !byte_xor)
718 return sim_core_write_buffer (sd, cpu, map, buffer, addr, nr_bytes);
719 else
720 /* only break up transfers when xor-endian is both selected and enabled */
721 {
fd89abc2 722 unsigned_1 x[WITH_XOR_ENDIAN + 1]; /* +1 to avoid zero sized array */
f90b720b
AC
723 unsigned nr_transfered = 0;
724 address_word start = addr;
725 unsigned nr_this_transfer = (WITH_XOR_ENDIAN - (addr & ~(WITH_XOR_ENDIAN - 1)));
726 address_word stop;
727 /* initial and intermediate transfers are broken when they cross
728 an XOR endian boundary */
729 while (nr_transfered + nr_this_transfer < nr_bytes)
730 /* initial/intermediate transfers */
731 {
732 /* since xor-endian is enabled stop^xor defines the start
733 address of the transfer */
734 stop = start + nr_this_transfer - 1;
735 SIM_ASSERT (start <= stop);
736 SIM_ASSERT ((stop ^ byte_xor) <= (start ^ byte_xor));
737 reverse_n (x, &((unsigned_1*)buffer)[nr_transfered], nr_this_transfer);
738 if (sim_core_read_buffer (sd, cpu, map, x, stop ^ byte_xor, nr_this_transfer)
739 != nr_this_transfer)
740 return nr_transfered;
741 nr_transfered += nr_this_transfer;
742 nr_this_transfer = WITH_XOR_ENDIAN;
743 start = stop + 1;
744 }
745 /* final transfer */
746 nr_this_transfer = nr_bytes - nr_transfered;
747 stop = start + nr_this_transfer - 1;
748 SIM_ASSERT (stop == (addr + nr_bytes - 1));
749 reverse_n (x, &((unsigned_1*)buffer)[nr_transfered], nr_this_transfer);
750 if (sim_core_read_buffer (sd, cpu, map, x, stop ^ byte_xor, nr_this_transfer)
751 != nr_this_transfer)
752 return nr_transfered;
753 return nr_bytes;
754 }
755}
cd0d873d
AC
756
757
758
f45dd42b 759/* define the read/write 1/2/4/8/16/word functions */
f2de7dfd 760
63be8feb 761#define N 16
f2de7dfd 762#include "sim-n-core.h"
f2de7dfd 763
63be8feb
AC
764#define N 8
765#include "sim-n-core.h"
766
767#define N 7
768#define M 8
769#include "sim-n-core.h"
770
771#define N 6
772#define M 8
773#include "sim-n-core.h"
774
775#define N 5
776#define M 8
f2de7dfd 777#include "sim-n-core.h"
f2de7dfd
AC
778
779#define N 4
780#include "sim-n-core.h"
f2de7dfd 781
63be8feb
AC
782#define N 3
783#define M 4
f2de7dfd 784#include "sim-n-core.h"
f2de7dfd 785
63be8feb
AC
786#define N 2
787#include "sim-n-core.h"
788
789#define N 1
f45dd42b 790#include "sim-n-core.h"
f45dd42b 791
f2de7dfd 792#endif
This page took 0.090083 seconds and 4 git commands to generate.