diff options
Diffstat (limited to 'hw/lpc-port80h.c')
-rw-r--r-- | hw/lpc-port80h.c | 78 |
1 files changed, 78 insertions, 0 deletions
diff --git a/hw/lpc-port80h.c b/hw/lpc-port80h.c index 72ac8b2..60bde92 100644 --- a/hw/lpc-port80h.c +++ b/hw/lpc-port80h.c @@ -89,11 +89,89 @@ static inline uint8_t op_display_to_port80(uint8_t last_value, enum op_severity return r; } +/* + * Convert our detailed op_display() call into 2 bytes for LPC port 81h and 82h + * + * This looks pretty similar to our port80 code. + * Notably we now have more bits to throw progress into. + * + * Our layout looks like this: + * MSB (bit 15): 1 = Comes from OPAL + * bit 14 : 0 = OP_MOD_INIT (the main one), 1 = (see bit 13) + * bits 13-2 : (if bit 6=0, low 12 bits of op-panel code) + * bit 13,12 : (if bit 6=1, other OP_MOD_ values in bits 13 and 12: + * 00b=OP_MOD_CPU, 01b=OP_MOD_LOCK, + * 10b=OP_MOD_MEM, 11b=OP_MOD_CHIPTOD) + * and bits 11-2 are low 10 bits of op-panel code) + * + * bit 1,0: 00b=OP_LOG, 10b=OP_WARN, 01b=OP_ERROR, 11b=OP_FATAL + * i.e. bit 0 indicates ERROR or FATAL. + * + * If port 80h number has the MSB and LSB set, then you died in OPAL. + * Any *odd* number with the MSB set (i.e. > 0x80) indicates error. + */ +static inline uint16_t op_display_to_port8x(uint16_t last_value, enum op_severity s, enum op_module m, uint16_t c) +{ + uint16_t r = 0x8000; /* Start with top bit set indicating in OPAL */ + + switch(m) { + case OP_MOD_INIT: + /* bit 6 is zero */ + /* bits 13 through 2 have low 12 bits of c */ + r |= (c & 0xFFF) << 2; + break; + case OP_MOD_CPU: + r |= 0x4000 | (c & 0x03FF) << 2; + break; + case OP_MOD_LOCK: + r |= 0x5000 | (c & 0x03FF) << 2; + break; + case OP_MOD_MEM: + r |= 0x6000 | (c & 0x03FF) << 2; + break; + case OP_MOD_CHIPTOD: + r |= 0x7000 | (c & 0x03FF) << 2; + break; + case OP_MOD_CORE: + /* + * Only current OP_MOD_CORE is where we're OP_FATAL, + * So let's go for the last value set and tweak the + * bits for OP_FATAL. + */ + r = last_value & 0xFFFC; + break; + case OP_MOD_FSP: + case OP_MOD_FSPCON: + /* Should never be hit, port80h only used on non-FSP! */ + break; + } + + switch(s) { + case OP_LOG: + break; + case OP_WARN: + r |= 0x02; + break; + case OP_ERROR: + r |= 0x01; + break; + case OP_FATAL: + r |= 0x03; + } + + return r; +} + + void op_display_lpc(enum op_severity s, enum op_module m, uint16_t c) { static uint8_t port80_val = 0x80; + static uint16_t port8x_val = 0x8000; port80_val = op_display_to_port80(port80_val, s, m, c); lpc_outb(port80_val, 0x80); + port8x_val = op_display_to_port8x(port8x_val, s, m, c); + lpc_outb(port8x_val >> 8, 0x81); + lpc_outb(port8x_val & 0xFF, 0x82); } |