| void glue(do_lsw, MEMSUFFIX) (int dst) |
| { |
| uint32_t tmp; |
| int sh; |
| |
| #if 0 |
| if (loglevel > 0) { |
| fprintf(logfile, "%s: addr=0x%08x count=%d reg=%d\n", |
| __func__, T0, T1, dst); |
| } |
| #endif |
| for (; T1 > 3; T1 -= 4, T0 += 4) { |
| ugpr(dst++) = glue(ldl, MEMSUFFIX)(T0); |
| if (dst == 32) |
| dst = 0; |
| } |
| if (T1 > 0) { |
| tmp = 0; |
| for (sh = 24; T1 > 0; T1--, T0++, sh -= 8) { |
| tmp |= glue(ldub, MEMSUFFIX)(T0) << sh; |
| } |
| ugpr(dst) = tmp; |
| } |
| } |
| |
| void glue(do_stsw, MEMSUFFIX) (int src) |
| { |
| int sh; |
| |
| #if 0 |
| if (loglevel > 0) { |
| fprintf(logfile, "%s: addr=0x%08x count=%d reg=%d\n", |
| __func__, T0, T1, src); |
| } |
| #endif |
| for (; T1 > 3; T1 -= 4, T0 += 4) { |
| glue(stl, MEMSUFFIX)(T0, ugpr(src++)); |
| if (src == 32) |
| src = 0; |
| } |
| if (T1 > 0) { |
| for (sh = 24; T1 > 0; T1--, T0++, sh -= 8) |
| glue(stb, MEMSUFFIX)(T0, (ugpr(src) >> sh) & 0xFF); |
| } |
| } |
| |
| void glue(do_lsw_le, MEMSUFFIX) (int dst) |
| { |
| uint32_t tmp; |
| int sh; |
| |
| #if 0 |
| if (loglevel > 0) { |
| fprintf(logfile, "%s: addr=0x%08x count=%d reg=%d\n", |
| __func__, T0, T1, dst); |
| } |
| #endif |
| for (; T1 > 3; T1 -= 4, T0 += 4) { |
| tmp = glue(ldl, MEMSUFFIX)(T0); |
| ugpr(dst++) = ((tmp & 0xFF000000) >> 24) | ((tmp & 0x00FF0000) >> 8) | |
| ((tmp & 0x0000FF00) << 8) | ((tmp & 0x000000FF) << 24); |
| if (dst == 32) |
| dst = 0; |
| } |
| if (T1 > 0) { |
| tmp = 0; |
| for (sh = 0; T1 > 0; T1--, T0++, sh += 8) { |
| tmp |= glue(ldub, MEMSUFFIX)(T0) << sh; |
| } |
| ugpr(dst) = tmp; |
| } |
| } |
| |
| void glue(do_stsw_le, MEMSUFFIX) (int src) |
| { |
| uint32_t tmp; |
| int sh; |
| |
| #if 0 |
| if (loglevel > 0) { |
| fprintf(logfile, "%s: addr=0x%08x count=%d reg=%d\n", |
| __func__, T0, T1, src); |
| } |
| #endif |
| for (; T1 > 3; T1 -= 4, T0 += 4) { |
| tmp = ((ugpr(src++) & 0xFF000000) >> 24); |
| tmp |= ((ugpr(src++) & 0x00FF0000) >> 8); |
| tmp |= ((ugpr(src++) & 0x0000FF00) << 8); |
| tmp |= ((ugpr(src++) & 0x000000FF) << 24); |
| glue(stl, MEMSUFFIX)(T0, tmp); |
| if (src == 32) |
| src = 0; |
| } |
| if (T1 > 0) { |
| for (sh = 0; T1 > 0; T1--, T0++, sh += 8) |
| glue(stb, MEMSUFFIX)(T0, (ugpr(src) >> sh) & 0xFF); |
| } |
| } |
| |
| #undef MEMSUFFIX |
