1 /* This file is part of the program psim.
3 Copyright (C) 1994-1997, Andrew Cagney <cagney@highland.com.au>
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.
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.
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.
23 #error "N must be #defined"
28 /* NOTE: see end of file for #undef of these macros */
29 #define unsigned_N XCONCAT2(unsigned_,N)
30 #define T2H_N XCONCAT2(T2H_,N)
31 #define H2T_N XCONCAT2(H2T_,N)
33 #define sim_core_read_aligned_N XCONCAT2(sim_core_read_aligned_,N)
34 #define sim_core_write_aligned_N XCONCAT2(sim_core_write_aligned_,N)
35 #define sim_core_read_unaligned_N XCONCAT2(sim_core_read_unaligned_,N)
36 #define sim_core_write_unaligned_N XCONCAT2(sim_core_write_unaligned_,N)
37 #define sim_core_trace_N XCONCAT2(sim_core_trace_,N)
40 /* TAGS: sim_core_trace_1 sim_core_trace_2 */
41 /* TAGS: sim_core_trace_4 sim_core_trace_8 */
42 /* TAGS: sim_core_trace_16 sim_core_trace_word */
45 sim_core_trace_N (sim_cpu *cpu,
54 trace_printf (CPU_STATE (cpu), cpu,
55 "sim-n-core.h:%d: %s-%d %s:0x%08lx -> 0x%08lx%08lx%08lx%08lx\n",
57 transfer, sizeof (unsigned_N),
58 sim_core_map_to_str (map),
60 (unsigned long) V4_16 (val, 0),
61 (unsigned long) V4_16 (val, 1),
62 (unsigned long) V4_16 (val, 2),
63 (unsigned long) V4_16 (val, 3));
66 trace_printf (CPU_STATE (cpu), cpu,
67 "sim-n-core.h:%d: %s-%d %s:0x%08lx -> 0x%08lx%08lx\n",
69 transfer, sizeof (unsigned_N),
70 sim_core_map_to_str (map),
72 (unsigned long) V4_8 (val, 0),
73 (unsigned long) V4_8 (val, 1));
76 trace_printf (CPU_STATE (cpu), cpu,
77 "sim-n-core.h:%d: %s-%d %s:0x%08lx -> 0x%0*lx\n",
79 transfer, sizeof (unsigned_N),
80 sim_core_map_to_str (map),
82 sizeof (unsigned_N) * 2,
88 /* TAGS: sim_core_read_aligned_1 sim_core_read_aligned_2 */
89 /* TAGS: sim_core_read_aligned_4 sim_core_read_aligned_8 */
90 /* TAGS: sim_core_read_aligned_16 sim_core_read_aligned_word */
92 INLINE_SIM_CORE(unsigned_N)
93 sim_core_read_aligned_N(sim_cpu *cpu,
98 sim_cpu_core *cpu_core = CPU_CORE (cpu);
99 sim_core_common *core = &cpu_core->common;
101 sim_core_mapping *mapping;
103 #if WITH_XOR_ENDIAN != 0
105 addr = xaddr ^ cpu_core->xor[(sizeof(unsigned_N) - 1) % WITH_XOR_ENDIAN];
109 mapping = sim_core_find_mapping (core, map,
113 1 /*abort*/, cpu, cia);
115 if (WITH_CALLBACK_MEMORY && mapping->device != NULL) {
117 if (device_io_read_buffer (mapping->device,
121 sizeof (unsigned_N)) != sizeof (unsigned_N))
122 device_error (mapping->device, "internal error - %s - io_read_buffer should not fail",
123 XSTRING (sim_core_read_aligned_N));
128 val = T2H_N (*(unsigned_N*) sim_core_translate (mapping, addr));
129 PROFILE_COUNT_CORE (cpu, addr, sizeof (unsigned_N), map);
130 if (TRACE_P (cpu, TRACE_CORE_IDX))
131 sim_core_trace_N (cpu, cia, __LINE__, "read", map, addr, val);
135 /* TAGS: sim_core_read_unaligned_1 sim_core_read_unaligned_2 */
136 /* TAGS: sim_core_read_unaligned_4 sim_core_read_unaligned_8 */
137 /* TAGS: sim_core_read_unaligned_16 sim_core_read_unaligned_word */
139 INLINE_SIM_CORE(unsigned_N)
140 sim_core_read_unaligned_N(sim_cpu *cpu,
145 int alignment = sizeof (unsigned_N) - 1;
146 /* if hardwired to forced alignment just do it */
147 if (WITH_ALIGNMENT == FORCED_ALIGNMENT)
148 return sim_core_read_aligned_N (cpu, cia, map, addr & ~alignment);
149 else if ((addr & alignment) == 0)
150 return sim_core_read_aligned_N (cpu, cia, map, addr);
152 switch (CURRENT_ALIGNMENT)
154 case STRICT_ALIGNMENT:
155 SIM_CORE_SIGNAL (CPU_STATE (cpu), cpu, cia, map,
156 sizeof (unsigned_N), addr,
157 read_transfer, sim_core_unaligned_signal);
158 case NONSTRICT_ALIGNMENT:
161 if (sim_core_xor_read_buffer (CPU_STATE (cpu), cpu, map, &val, addr,
163 != sizeof(unsigned_N))
164 SIM_CORE_SIGNAL (CPU_STATE (cpu), cpu, cia, map,
165 sizeof (unsigned_N), addr,
166 read_transfer, sim_core_unaligned_signal);
168 PROFILE_COUNT_CORE (cpu, addr, sizeof (unsigned_N), map);
171 case FORCED_ALIGNMENT:
172 return sim_core_read_aligned_N (cpu, cia, map, addr & ~alignment);
173 case MIXED_ALIGNMENT:
174 sim_engine_abort (CPU_STATE (cpu), cpu, cia,
175 "internal error - %s - mixed alignment",
176 XSTRING (sim_core_read_unaligned_N));
178 sim_engine_abort (CPU_STATE (cpu), cpu, cia,
179 "internal error - %s - bad switch",
180 XSTRING (sim_core_read_unaligned_N));
181 /* to keep some compilers happy, we return a dummy */
183 unsigned_N val[1] = { };
189 /* TAGS: sim_core_write_aligned_1 sim_core_write_aligned_2 */
190 /* TAGS: sim_core_write_aligned_4 sim_core_write_aligned_8 */
191 /* TAGS: sim_core_write_aligned_16 sim_core_write_aligned_word */
193 INLINE_SIM_CORE(void)
194 sim_core_write_aligned_N(sim_cpu *cpu,
200 sim_cpu_core *cpu_core = CPU_CORE (cpu);
201 sim_core_common *core = &cpu_core->common;
202 sim_core_mapping *mapping;
204 #if WITH_XOR_ENDIAN != 0
206 addr = xaddr ^ cpu_core->xor[(sizeof(unsigned_N) - 1) % WITH_XOR_ENDIAN];
210 mapping = sim_core_find_mapping(core, map,
214 1 /*abort*/, cpu, cia);
216 if (WITH_CALLBACK_MEMORY && mapping->device != NULL) {
217 unsigned_N data = H2T_N (val);
218 if (device_io_write_buffer (mapping->device,
222 sizeof (unsigned_N), /* nr_bytes */
224 cia) != sizeof (unsigned_N))
225 device_error (mapping->device, "internal error - %s - io_write_buffer should not fail",
226 XSTRING (sim_core_write_aligned_N));
230 *(unsigned_N*) sim_core_translate (mapping, addr) = H2T_N (val);
231 PROFILE_COUNT_CORE (cpu, addr, sizeof (unsigned_N), map);
232 if (TRACE_P (cpu, TRACE_CORE_IDX))
233 sim_core_trace_N (cpu, cia, __LINE__, "write", map, addr, val);
236 /* TAGS: sim_core_write_unaligned_1 sim_core_write_unaligned_2 */
237 /* TAGS: sim_core_write_unaligned_4 sim_core_write_unaligned_8 */
238 /* TAGS: sim_core_write_unaligned_16 sim_core_write_unaligned_word */
240 INLINE_SIM_CORE(void)
241 sim_core_write_unaligned_N(sim_cpu *cpu,
247 int alignment = sizeof (unsigned_N) - 1;
248 /* if hardwired to forced alignment just do it */
249 if (WITH_ALIGNMENT == FORCED_ALIGNMENT)
250 sim_core_write_aligned_N (cpu, cia, map, addr & ~alignment, val);
251 else if ((addr & alignment) == 0)
252 sim_core_write_aligned_N (cpu, cia, map, addr, val);
254 switch (CURRENT_ALIGNMENT)
256 case STRICT_ALIGNMENT:
257 SIM_CORE_SIGNAL (CPU_STATE (cpu), cpu, cia, map,
258 sizeof (unsigned_N), addr,
259 write_transfer, sim_core_unaligned_signal);
261 case NONSTRICT_ALIGNMENT:
263 unsigned_N val = H2T_N (val);
264 if (sim_core_xor_write_buffer (CPU_STATE (cpu), cpu, map, &val, addr,
266 != sizeof(unsigned_N))
267 SIM_CORE_SIGNAL (CPU_STATE (cpu), cpu, cia, map,
268 sizeof (unsigned_N), addr,
269 write_transfer, sim_core_unaligned_signal);
270 PROFILE_COUNT_CORE (cpu, addr, sizeof (unsigned_N), map);
273 case FORCED_ALIGNMENT:
274 sim_core_write_aligned_N (cpu, cia, map, addr & ~alignment, val);
276 case MIXED_ALIGNMENT:
277 sim_engine_abort (CPU_STATE (cpu), cpu, cia,
278 "internal error - %s - mixed alignment",
279 XSTRING (sim_core_write_unaligned_N));
282 sim_engine_abort (CPU_STATE (cpu), cpu, cia,
283 "internal error - %s - bad switch",
284 XSTRING (sim_core_write_unaligned_N));
290 /* NOTE: see start of file for #define of these macros */
294 #undef sim_core_read_aligned_N
295 #undef sim_core_write_aligned_N
296 #undef sim_core_read_unaligned_N
297 #undef sim_core_write_unaligned_N
298 #undef sim_core_trace_N