![[BACK]](/icons/back.gif){kind=icon}
Return to m88100_machdep.c CVS log ![[TXT]](/icons/text.gif){kind=icon}
![[DIR]](/icons/dir.gif){kind=icon}
Up to [local] / sys / arch / m88k / m88k|
Return to m88100_machdep.c CVS log | Up to [local] / sys / arch / m88k / m88k |
1.1 ! nbrk 1: /* $OpenBSD: m88100_machdep.c,v 1.3 2007/05/20 20:12:31 miod Exp $ */
! 2: /*
! 3: * Mach Operating System
! 4: * Copyright (c) 1993-1991 Carnegie Mellon University
! 5: * Copyright (c) 1991 OMRON Corporation
! 6: * All Rights Reserved.
! 7: *
! 8: * Permission to use, copy, modify and distribute this software and its
! 9: * documentation is hereby granted, provided that both the copyright
! 10: * notice and this permission notice appear in all copies of the
! 11: * software, derivative works or modified versions, and any portions
! 12: * thereof, and that both notices appear in supporting documentation.
! 13: *
! 14: * CARNEGIE MELLON AND OMRON ALLOW FREE USE OF THIS SOFTWARE IN ITS "AS IS"
! 15: * CONDITION. CARNEGIE MELLON AND OMRON DISCLAIM ANY LIABILITY OF ANY KIND
! 16: * FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
! 17: *
! 18: * Carnegie Mellon requests users of this software to return to
! 19: *
! 20: * Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU
! 21: * School of Computer Science
! 22: * Carnegie Mellon University
! 23: * Pittsburgh PA 15213-3890
! 24: *
! 25: * any improvements or extensions that they make and grant Carnegie the
! 26: * rights to redistribute these changes.
! 27: */
! 28:
! 29: #include "assym.h" /* EF_xxx */
! 30:
! 31: #include <sys/param.h>
! 32: #include <sys/systm.h>
! 33:
! 34: #include <machine/asm_macro.h>
! 35: #include <m88k/m88100.h>
! 36:
! 37: /*
! 38: * Data Access Emulation for M88100 exceptions
! 39: */
! 40:
! 41: #define DMT_BYTE 1
! 42: #define DMT_HALF 2
! 43: #define DMT_WORD 4
! 44:
! 45: const struct {
! 46: unsigned char offset;
! 47: unsigned char size;
! 48: } dmt_en_info[16] = {
! 49: {0, 0}, {3, DMT_BYTE}, {2, DMT_BYTE}, {2, DMT_HALF},
! 50: {1, DMT_BYTE}, {0, 0}, {0, 0}, {0, 0},
! 51: {0, DMT_BYTE}, {0, 0}, {0, 0}, {0, 0},
! 52: {0, DMT_HALF}, {0, 0}, {0, 0}, {0, DMT_WORD}
! 53: };
! 54:
! 55: #ifdef DATA_DEBUG
! 56: int data_access_emulation_debug = 0;
! 57: #define DAE_DEBUG(stuff) \
! 58: do { \
! 59: if (data_access_emulation_debug != 0) { \
! 60: stuff; \
! 61: } \
! 62: } while (0)
! 63: #else
! 64: #define DAE_DEBUG(stuff)
! 65: #endif
! 66:
! 67: void
! 68: dae_print(unsigned *eframe)
! 69: {
! 70: int x;
! 71: unsigned dmax, dmdx, dmtx;
! 72:
! 73: if (!ISSET(eframe[EF_DMT0], DMT_VALID))
! 74: return;
! 75:
! 76: for (x = 0; x < 3; x++) {
! 77: dmtx = eframe[EF_DMT0 + x * 3];
! 78: if (!ISSET(dmtx, DMT_VALID))
! 79: continue;
! 80:
! 81: dmdx = eframe[EF_DMD0 + x * 3];
! 82: dmax = eframe[EF_DMA0 + x * 3];
! 83:
! 84: if (ISSET(dmtx, DMT_WRITE))
! 85: printf("[DMT%d=%x: st.%c %x to %x as %d %s %s]\n",
! 86: x, dmtx, dmtx & DMT_DAS ? 's' : 'u', dmdx, dmax,
! 87: DMT_ENBITS(dmtx),
! 88: dmtx & DMT_DOUB1 ? "double": "not double",
! 89: dmtx & DMT_LOCKBAR ? "xmem": "not xmem");
! 90: else
! 91: printf("[DMT%d=%x: ld.%c r%d <- %x as %d %s %s]\n",
! 92: x, dmtx, dmtx & DMT_DAS ? 's' : 'u',
! 93: DMT_DREGBITS(dmtx), dmax, DMT_ENBITS(dmtx),
! 94: dmtx & DMT_DOUB1 ? "double": "not double",
! 95: dmtx & DMT_LOCKBAR ? "xmem": "not xmem");
! 96: }
! 97: }
! 98:
! 99: void
! 100: data_access_emulation(unsigned *eframe)
! 101: {
! 102: int x;
! 103: unsigned dmax, dmdx, dmtx;
! 104: unsigned v, reg;
! 105:
! 106: dmtx = eframe[EF_DMT0];
! 107: if (!ISSET(dmtx, DMT_VALID))
! 108: return;
! 109:
! 110: for (x = 0; x < 3; x++) {
! 111: dmtx = eframe[EF_DMT0 + x * 3];
! 112: if (!ISSET(dmtx, DMT_VALID) || ISSET(dmtx, DMT_SKIP))
! 113: continue;
! 114:
! 115: dmdx = eframe[EF_DMD0 + x * 3];
! 116: dmax = eframe[EF_DMA0 + x * 3];
! 117:
! 118: DAE_DEBUG(
! 119: if (ISSET(dmtx, DMT_WRITE))
! 120: printf("[DMT%d=%x: st.%c %x to %x as %d %s %s]\n",
! 121: x, dmtx, dmtx & DMT_DAS ? 's' : 'u', dmdx, dmax,
! 122: DMT_ENBITS(dmtx),
! 123: dmtx & DMT_DOUB1 ? "double": "not double",
! 124: dmtx & DMT_LOCKBAR ? "xmem": "not xmem");
! 125: else
! 126: printf("[DMT%d=%x: ld.%c r%d <- %x as %d %s %s]\n",
! 127: x, dmtx, dmtx & DMT_DAS ? 's' : 'u',
! 128: DMT_DREGBITS(dmtx), dmax, DMT_ENBITS(dmtx),
! 129: dmtx & DMT_DOUB1 ? "double": "not double",
! 130: dmtx & DMT_LOCKBAR ? "xmem": "not xmem")
! 131: );
! 132:
! 133: dmax += dmt_en_info[DMT_ENBITS(dmtx)].offset;
! 134: reg = DMT_DREGBITS(dmtx);
! 135:
! 136: if (!ISSET(dmtx, DMT_LOCKBAR)) {
! 137: /* the fault is not during an XMEM */
! 138:
! 139: if (x == 2 && ISSET(dmtx, DMT_DOUB1)) {
! 140: /* pipeline 2 (earliest stage) for a double */
! 141:
! 142: if (ISSET(dmtx, DMT_WRITE)) {
! 143: /*
! 144: * STORE DOUBLE WILL BE REINITIATED
! 145: * BY rte
! 146: */
! 147: } else {
! 148: /* EMULATE ld.d INSTRUCTION */
! 149: v = do_load_word(dmax, dmtx & DMT_DAS);
! 150: if (reg != 0)
! 151: eframe[EF_R0 + reg] = v;
! 152: v = do_load_word(dmax ^ 4,
! 153: dmtx & DMT_DAS);
! 154: if (reg != 31)
! 155: eframe[EF_R0 + reg + 1] = v;
! 156: }
! 157: } else {
! 158: /* not pipeline #2 with a double */
! 159: if (dmtx & DMT_WRITE) {
! 160: switch (dmt_en_info[DMT_ENBITS(dmtx)].size) {
! 161: case DMT_BYTE:
! 162: DAE_DEBUG(
! 163: printf("[byte %x -> [%x(%c)]\n",
! 164: dmdx & 0xff, dmax,
! 165: ISSET(dmtx, DMT_DAS) ? 's' : 'u')
! 166: );
! 167: do_store_byte(dmax, dmdx,
! 168: dmtx & DMT_DAS);
! 169: break;
! 170: case DMT_HALF:
! 171: DAE_DEBUG(
! 172: printf("[half %x -> [%x(%c)]\n",
! 173: dmdx & 0xffff, dmax,
! 174: ISSET(dmtx, DMT_DAS) ? 's' : 'u')
! 175: );
! 176: do_store_half(dmax, dmdx,
! 177: dmtx & DMT_DAS);
! 178: break;
! 179: case DMT_WORD:
! 180: DAE_DEBUG(
! 181: printf("[word %x -> [%x(%c)]\n",
! 182: dmdx, dmax,
! 183: ISSET(dmtx, DMT_DAS) ? 's' : 'u')
! 184: );
! 185: do_store_word(dmax, dmdx,
! 186: dmtx & DMT_DAS);
! 187: break;
! 188: }
! 189: } else {
! 190: /* else it's a read */
! 191: switch (dmt_en_info[DMT_ENBITS(dmtx)].size) {
! 192: case DMT_BYTE:
! 193: v = do_load_byte(dmax,
! 194: dmtx & DMT_DAS);
! 195: if (!ISSET(dmtx, DMT_SIGNED))
! 196: v &= 0x000000ff;
! 197: break;
! 198: case DMT_HALF:
! 199: v = do_load_half(dmax,
! 200: dmtx & DMT_DAS);
! 201: if (!ISSET(dmtx, DMT_SIGNED))
! 202: v &= 0x0000ffff;
! 203: break;
! 204: case DMT_WORD:
! 205: v = do_load_word(dmax,
! 206: dmtx & DMT_DAS);
! 207: break;
! 208: }
! 209: DAE_DEBUG(
! 210: if (reg == 0)
! 211: printf("[no write to r0 done]\n");
! 212: else
! 213: printf("[r%d <- %x]\n", reg, v);
! 214: );
! 215: if (reg != 0)
! 216: eframe[EF_R0 + reg] = v;
! 217: }
! 218: }
! 219: } else {
! 220: /* if lockbar is set... it's part of an XMEM */
! 221: /*
! 222: * According to Motorola's "General Information",
! 223: * the DMT_DOUB1 bit is never set in this case, as it
! 224: * should be.
! 225: * If lockbar is set (as it is if we're here) and if
! 226: * the write is not set, then it's the same as if DOUB1
! 227: * was set...
! 228: */
! 229: if (!ISSET(dmtx, DMT_WRITE)) {
! 230: if (x != 2) {
! 231: /* RERUN xmem WITH DMD(x+1) */
! 232: x++;
! 233: dmdx = eframe[EF_DMD0 + x * 3];
! 234: } else {
! 235: /* RERUN xmem WITH DMD2 */
! 236: }
! 237:
! 238: if (dmt_en_info[DMT_ENBITS(dmtx)].size ==
! 239: DMT_WORD) {
! 240: v = do_xmem_word(dmax, dmdx,
! 241: dmtx & DMT_DAS);
! 242: } else {
! 243: v = do_xmem_byte(dmax, dmdx,
! 244: dmtx & DMT_DAS);
! 245: }
! 246: if (reg != 0)
! 247: eframe[EF_R0 + reg] = v;
! 248: } else {
! 249: if (x == 0) {
! 250: if (reg != 0)
! 251: eframe[EF_R0 + reg] = dmdx;
! 252: eframe[EF_SFIP] = eframe[EF_SNIP];
! 253: eframe[EF_SNIP] = eframe[EF_SXIP];
! 254: eframe[EF_SXIP] = 0;
! 255: /* xmem RERUN ON rte */
! 256: eframe[EF_DMT0] = 0;
! 257: return;
! 258: }
! 259: }
! 260: }
! 261: }
! 262: eframe[EF_DMT0] = 0;
! 263: }
! 264:
! 265: /*
! 266: * Routines to patch the kernel code on 88100 systems not affected by
! 267: * the xxx.usr bug.
! 268: */
! 269:
! 270: void
! 271: m88100_apply_patches()
! 272: {
! 273: #ifdef ERRATA__XXX_USR
! 274: if (((get_cpu_pid() & PID_VN) >> VN_SHIFT) > 10) {
! 275: /*
! 276: * Patch DAE helpers.
! 277: * before after
! 278: * branch branch
! 279: * NOP jmp.n r1
! 280: * xxx.usr xxx.usr
! 281: * NOP; NOP; NOP
! 282: * jmp r1
! 283: */
! 284: ((u_int32_t *)(do_load_word))[1] = 0xf400c401;
! 285: ((u_int32_t *)(do_load_half))[1] = 0xf400c401;
! 286: ((u_int32_t *)(do_load_byte))[1] = 0xf400c401;
! 287: ((u_int32_t *)(do_store_word))[1] = 0xf400c401;
! 288: ((u_int32_t *)(do_store_half))[1] = 0xf400c401;
! 289: ((u_int32_t *)(do_store_byte))[1] = 0xf400c401;
! 290: ((u_int32_t *)(do_xmem_word))[1] = 0xf400c401;
! 291: ((u_int32_t *)(do_xmem_byte))[1] = 0xf400c401;
! 292: }
! 293: #endif
! 294: }