]>
Commit | Line | Data |
---|---|---|
c906108c SS |
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 | |
3fd725ef | 7 | the Free Software Foundation; either version 3 of the License, or |
c906108c SS |
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 N | |
23 | #error "N must be #defined" | |
24 | #endif | |
25 | ||
26 | /* NOTE: See end of file for #undef */ | |
27 | #define unsigned_N XCONCAT2(unsigned_,N) | |
28 | #define T2H_N XCONCAT2(T2H_,N) | |
29 | #define H2T_N XCONCAT2(H2T_,N) | |
30 | #define vm_data_map_read_N XCONCAT2(vm_data_map_read_,N) | |
31 | #define vm_data_map_write_N XCONCAT2(vm_data_map_write_,N) | |
32 | ||
33 | ||
34 | INLINE_VM\ | |
35 | (unsigned_N) | |
36 | vm_data_map_read_N(vm_data_map *map, | |
37 | unsigned_word ea, | |
38 | cpu *processor, | |
39 | unsigned_word cia) | |
40 | { | |
41 | if ((ea & (sizeof(unsigned_N)-1)) == 0) { | |
42 | unsigned ra = vm_real_data_addr(map, ea, 1/*is-read*/, processor, cia); | |
43 | unsigned_N val; | |
44 | if (WITH_XOR_ENDIAN) | |
45 | ra ^= map->translation.xor[sizeof(unsigned_N) - 1]; | |
46 | val = XCONCAT2(core_map_read_,N)(map->read, ra, processor, cia); | |
47 | if (WITH_MON & MONITOR_LOAD_STORE_UNIT) | |
48 | mon_read(ea, ra, sizeof(unsigned_N), processor, cia); | |
49 | TRACE(trace_load_store, ("load cia=0x%lx ea=0x%lx N=%ld val=0x%lx\n", | |
50 | (long)cia, (long)ea, (long)sizeof(unsigned_N), (long)val)); | |
51 | return val; | |
52 | } | |
53 | else { | |
54 | switch (CURRENT_ALIGNMENT) { | |
55 | case STRICT_ALIGNMENT: | |
56 | alignment_interrupt(processor, cia, ea); | |
57 | return 0; | |
58 | case NONSTRICT_ALIGNMENT: | |
59 | { | |
60 | unsigned_N val; | |
61 | if (vm_data_map_read_buffer(map, &val, ea, sizeof(unsigned_N), processor, cia) | |
62 | != sizeof(unsigned_N)) { | |
63 | cpu_error(processor, cia, "misaligned %d byte read to 0x%lx failed", | |
64 | sizeof(unsigned_N), (unsigned long)ea); | |
65 | } | |
66 | val = T2H_N(val); | |
67 | if (WITH_MON & MONITOR_LOAD_STORE_UNIT) { | |
68 | /* YUCK */ | |
69 | unsigned ra = vm_real_data_addr(map, ea, 1, processor, cia); | |
70 | mon_read(ea, ra, sizeof(unsigned_N), processor, cia); | |
71 | } | |
72 | TRACE(trace_load_store, ("load cia=0x%lx ea=0x%lx N=%ld data=0x%lx\n", | |
73 | (long)cia, (long)ea, (long)sizeof(unsigned_N), (long)val)); | |
74 | return val; | |
75 | } | |
76 | default: | |
77 | error("internal error - vm_data_map_read_N - bad switch"); | |
78 | return 0; | |
79 | } | |
80 | } | |
81 | } | |
82 | ||
83 | INLINE_VM\ | |
84 | (void) | |
85 | vm_data_map_write_N(vm_data_map *map, | |
86 | unsigned_word ea, | |
87 | unsigned_N val, | |
88 | cpu *processor, | |
89 | unsigned_word cia) | |
90 | { | |
91 | if ((ea & (sizeof(unsigned_N)-1)) == 0) { | |
92 | unsigned ra = vm_real_data_addr(map, ea, 0/*is-read?*/, processor, cia); | |
93 | if (WITH_XOR_ENDIAN) | |
94 | ra ^= map->translation.xor[sizeof(unsigned_N) - 1]; | |
95 | XCONCAT2(core_map_write_,N)(map->write, ra, val, processor, cia); | |
96 | if (WITH_MON & MONITOR_LOAD_STORE_UNIT) | |
97 | mon_write(ea, ra, sizeof(unsigned_N), processor, cia); | |
98 | TRACE(trace_load_store, ("store cia=0x%lx ea=0x%lx N=%ld val=0x%lx\n", | |
99 | (long)cia, (long)ea, (long)sizeof(unsigned_N), (long)val)); | |
100 | } | |
101 | else { | |
102 | switch (CURRENT_ALIGNMENT) { | |
103 | case STRICT_ALIGNMENT: | |
104 | alignment_interrupt(processor, cia, ea); | |
105 | break; | |
106 | case NONSTRICT_ALIGNMENT: | |
107 | { | |
108 | unsigned_N data = H2T_N(val); | |
109 | if (vm_data_map_write_buffer(map, &data, ea, sizeof(unsigned_N), 0, processor, cia) | |
110 | != sizeof(unsigned_N)) { | |
111 | cpu_error(processor, cia, "misaligned %d byte write to 0x%lx failed", | |
112 | sizeof(unsigned_N), (unsigned long)ea); | |
113 | } | |
114 | if (WITH_MON & MONITOR_LOAD_STORE_UNIT) { | |
115 | /* YUCK */ | |
116 | unsigned ra = vm_real_data_addr(map, ea, 1, processor, cia); | |
117 | mon_write(ea, ra, sizeof(unsigned_N), processor, cia); | |
118 | } | |
119 | TRACE(trace_load_store, ("store cia=0x%lx ea=0x%lx N=%ld val=0x%lx\n", | |
120 | (long)cia, (long)ea, (long)sizeof(unsigned_N), (long)val)); | |
121 | } | |
122 | break; | |
123 | default: | |
124 | error("internal error - vm_data_map_write_N - bad switch"); | |
125 | } | |
126 | } | |
127 | } | |
128 | ||
129 | /* NOTE: see start of file for #define */ | |
130 | #undef unsigned_N | |
131 | #undef T2H_N | |
132 | #undef H2T_N | |
133 | #undef vm_data_map_read_N | |
134 | #undef vm_data_map_write_N |