Mercurial > sarpn
changeset 2:68bac03da6ff
a bit of reorganization
| author | Josef 'Jeff' Sipek <jeffpc@josefsipek.net> |
|---|---|
| date | Sat, 26 Feb 2011 11:02:49 -0500 |
| parents | 29382f5864ca |
| children | ec991c3809db |
| files | Makefile arch/io.c src/io.c |
| diffstat | 3 files changed, 584 insertions(+), 582 deletions(-) [+] |
line wrap: on
line diff
--- a/Makefile Fri Feb 25 18:58:43 2011 -0500 +++ b/Makefile Sat Feb 26 11:02:49 2011 -0500 @@ -8,23 +8,25 @@ CFLAGS=-g -fno-strict-aliasing -fno-builtin -nostdinc -nostdlib -Wall -m64 -I include/ -O2 LDFLAGS=-m elf64_s390 -OBJS=src/init.o src/io.o +BINS=sarpn + +sarpn_OBJS=src/init.o arch/io.o .PHONY: all build clean tags -all: sarpn loader.bin +all: $(BINS) loader.bin @echo "Image is `stat -c %s sarpn` bytes" @echo "Loader is `stat -c %s loader.bin` bytes" clean: - rm -f $(OBJS) - rm -f sarpn + rm -f $(sarpn_OBJS) + rm -f $(BINS) rm -f loader.bin ipl/*.o ipl/*.rto ipl/ipl_ccws.S cscope.out tags: cscope -R -b -sarpn: $(OBJS) +sarpn: $(sarpn_OBJS) $(LD) $(LDFLAGS) -T scripts/linker.script -o $@ $^ %.o: %.S
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/arch/io.c Sat Feb 26 11:02:49 2011 -0500 @@ -0,0 +1,577 @@ +/* + * Tables taken from Linux's arch/s390/kernel/ebcdic.c + */ + +/* + * ASCII (IBM PC 437) -> EBCDIC 037 + */ +static u8 ascii2ebcdic_table[256] = +{ + /*00 NUL SOH STX ETX EOT ENQ ACK BEL */ + 0x00, 0x01, 0x02, 0x03, 0x37, 0x2D, 0x2E, 0x2F, + /*08 BS HT LF VT FF CR SO SI */ + /* ->NL */ + 0x16, 0x05, 0x15, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, + /*10 DLE DC1 DC2 DC3 DC4 NAK SYN ETB */ + 0x10, 0x11, 0x12, 0x13, 0x3C, 0x3D, 0x32, 0x26, + /*18 CAN EM SUB ESC FS GS RS US */ + /* ->IGS ->IRS ->IUS */ + 0x18, 0x19, 0x3F, 0x27, 0x22, 0x1D, 0x1E, 0x1F, + /*20 SP ! " # $ % & ' */ + 0x40, 0x5A, 0x7F, 0x7B, 0x5B, 0x6C, 0x50, 0x7D, + /*28 ( ) * + , - . / */ + 0x4D, 0x5D, 0x5C, 0x4E, 0x6B, 0x60, 0x4B, 0x61, + /*30 0 1 2 3 4 5 6 7 */ + 0xF0, 0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, + /*38 8 9 : ; < = > ? */ + 0xF8, 0xF9, 0x7A, 0x5E, 0x4C, 0x7E, 0x6E, 0x6F, + /*40 @ A B C D E F G */ + 0x7C, 0xC1, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, + /*48 H I J K L M N O */ + 0xC8, 0xC9, 0xD1, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, + /*50 P Q R S T U V W */ + 0xD7, 0xD8, 0xD9, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, + /*58 X Y Z [ \ ] ^ _ */ + 0xE7, 0xE8, 0xE9, 0xBA, 0xE0, 0xBB, 0xB0, 0x6D, + /*60 ` a b c d e f g */ + 0x79, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, + /*68 h i j k l m n o */ + 0x88, 0x89, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, + /*70 p q r s t u v w */ + 0x97, 0x98, 0x99, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, + /*78 x y z { | } ~ DL */ + 0xA7, 0xA8, 0xA9, 0xC0, 0x4F, 0xD0, 0xA1, 0x07, + /*80*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*88*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*90*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*98*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*A0*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*A8*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*B0*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*B8*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*C0*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*C8*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*D0*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*D8*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*E0 sz */ + 0x3F, 0x59, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*E8*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*F0*/ + 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, + /*F8*/ + 0x90, 0x3F, 0x3F, 0x3F, 0x3F, 0xEA, 0x3F, 0xFF +}; + +/* + * EBCDIC 037 -> ASCII (IBM PC 437) + */ +u8 ebcdic2ascii_table[256] = +{ + /* 0x00 NUL SOH STX ETX *SEL HT *RNL DEL */ + 0x00, 0x01, 0x02, 0x03, 0x07, 0x09, 0x07, 0x7F, + /* 0x08 -GE -SPS -RPT VT FF CR SO SI */ + 0x07, 0x07, 0x07, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, + /* 0x10 DLE DC1 DC2 DC3 -RES -NL BS -POC + -ENP ->LF */ + 0x10, 0x11, 0x12, 0x13, 0x07, 0x0A, 0x08, 0x07, + /* 0x18 CAN EM -UBS -CU1 -IFS -IGS -IRS -ITB + -IUS */ + 0x18, 0x19, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07, + /* 0x20 -DS -SOS FS -WUS -BYP LF ETB ESC + -INP */ + 0x07, 0x07, 0x1C, 0x07, 0x07, 0x0A, 0x17, 0x1B, + /* 0x28 -SA -SFE -SM -CSP -MFA ENQ ACK BEL + -SW */ + 0x07, 0x07, 0x07, 0x07, 0x07, 0x05, 0x06, 0x07, + /* 0x30 ---- ---- SYN -IR -PP -TRN -NBS EOT */ + 0x07, 0x07, 0x16, 0x07, 0x07, 0x07, 0x07, 0x04, + /* 0x38 -SBS -IT -RFF -CU3 DC4 NAK ---- SUB */ + 0x07, 0x07, 0x07, 0x07, 0x14, 0x15, 0x07, 0x1A, + /* 0x40 SP RSP ä ---- */ + 0x20, 0xFF, 0x83, 0x84, 0x85, 0xA0, 0x07, 0x86, + /* 0x48 . < ( + | */ + 0x87, 0xA4, 0x9B, 0x2E, 0x3C, 0x28, 0x2B, 0x7C, + /* 0x50 & ---- */ + 0x26, 0x82, 0x88, 0x89, 0x8A, 0xA1, 0x8C, 0x07, + /* 0x58 ß ! $ * ) ; */ + 0x8D, 0xE1, 0x21, 0x24, 0x2A, 0x29, 0x3B, 0xAA, + /* 0x60 - / ---- Ä ---- ---- ---- */ + 0x2D, 0x2F, 0x07, 0x8E, 0x07, 0x07, 0x07, 0x8F, + /* 0x68 ---- , % _ > ? */ + 0x80, 0xA5, 0x07, 0x2C, 0x25, 0x5F, 0x3E, 0x3F, + /* 0x70 ---- ---- ---- ---- ---- ---- ---- */ + 0x07, 0x90, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07, + /* 0x78 * ` : # @ ' = " */ + 0x70, 0x60, 0x3A, 0x23, 0x40, 0x27, 0x3D, 0x22, + /* 0x80 * a b c d e f g */ + 0x07, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67, + /* 0x88 h i ---- ---- ---- */ + 0x68, 0x69, 0xAE, 0xAF, 0x07, 0x07, 0x07, 0xF1, + /* 0x90 ° j k l m n o p */ + 0xF8, 0x6A, 0x6B, 0x6C, 0x6D, 0x6E, 0x6F, 0x70, + /* 0x98 q r ---- ---- */ + 0x71, 0x72, 0xA6, 0xA7, 0x91, 0x07, 0x92, 0x07, + /* 0xA0 ~ s t u v w x */ + 0xE6, 0x7E, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, + /* 0xA8 y z ---- ---- ---- ---- */ + 0x79, 0x7A, 0xAD, 0xAB, 0x07, 0x07, 0x07, 0x07, + /* 0xB0 ^ ---- § ---- */ + 0x5E, 0x9C, 0x9D, 0xFA, 0x07, 0x07, 0x07, 0xAC, + /* 0xB8 ---- [ ] ---- ---- ---- ---- */ + 0xAB, 0x07, 0x5B, 0x5D, 0x07, 0x07, 0x07, 0x07, + /* 0xC0 { A B C D E F G */ + 0x7B, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47, + /* 0xC8 H I ---- ö ---- */ + 0x48, 0x49, 0x07, 0x93, 0x94, 0x95, 0xA2, 0x07, + /* 0xD0 } J K L M N O P */ + 0x7D, 0x4A, 0x4B, 0x4C, 0x4D, 0x4E, 0x4F, 0x50, + /* 0xD8 Q R ---- ü */ + 0x51, 0x52, 0x07, 0x96, 0x81, 0x97, 0xA3, 0x98, + /* 0xE0 \ S T U V W X */ + 0x5C, 0xF6, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, + /* 0xE8 Y Z ---- Ö ---- ---- ---- */ + 0x59, 0x5A, 0xFD, 0x07, 0x99, 0x07, 0x07, 0x07, + /* 0xF0 0 1 2 3 4 5 6 7 */ + 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, + /* 0xF8 8 9 ---- ---- Ü ---- ---- ---- */ + 0x38, 0x39, 0x07, 0x07, 0x9A, 0x07, 0x07, 0x07 +}; + +/* + * Generic translate buffer function. + */ +static inline void __translate(u8 *buf, int len, const u8 *table) +{ + asm volatile( + " sr %%r0,%%r0\n" /* test byte = 0 */ + " la %%r2,0(%0)\n" /* buffer */ + " lr %%r3,%2\n" /* length */ + " la %%r4,0(%1)\n" /* table */ + " tre %%r2,%%r4\n" + : /* output */ + : /* input */ + "a" (buf), + "a" (table), + "d" (len) + : /* clobbered */ + "cc", "r0", "r2", "r3", "r4" + ); +} + +#define ascii2ebcdic(buf, len) \ + __translate((buf), (len), ascii2ebcdic_table) +#define ebcdic2ascii(buf, len) \ + __translate((buf), (len), ebcdic2ascii_table) + +/* console I/O functions */ + +#define CON_LEN 132 +#define CON_DEV 0x0009 + +struct pmcw { + /* word 0 */ + u32 interrupt_param; /* Interruption Parameter */ + + /* word 1*/ + u8 __zero1:2, + isc:3, /* I/O-Interruption-Subclass Code */ + __zero2:3; + u8 e:1, /* Enabled */ + lm:2, /* Limit Mode */ + mm:2, /* Measurement-Mode Enable */ + d:1, /* Multipath Mode */ + t:1, /* Timing Facility */ + v:1; /* Device Number Valid */ + u16 dev_num; /* Device Number */ + + /* word 2 */ + u8 lpm; /* Logical-Path Mask */ + u8 pnom; /* Path-Not-Operational Mask */ + u8 lpum; /* Last-Path-Used Mask */ + u8 pim; /* Path-Installed Mask */ + + /* word 3 */ + u16 mbi; /* Measurement-Block Index */ + u8 pom; /* Path-Operational Mask */ + u8 pam; /* Path-Available Mask */ + + /* word 4 & 5 */ + u8 chpid[8]; /* Channel-Path Identifiers */ + + /* word 6 */ + u16 __zero3; + u16 __zero4:13, + f:1, /* Measurement Block Format Control */ + x:1, /* Extended Measurement Word Mode Enable */ + s:1; /* Concurrent Sense */ +}; + +struct scsw { + /* word 0 */ + u16 key:4, /* Subchannel key */ + s:1, /* Suspend control */ + l:1, /* ESW format */ + cc:2, /* Deferred condition code */ + f:1, /* Format */ + p:1, /* Prefetch */ + i:1, /* Initial-status interruption control */ + a:1, /* Address-limit-checking control */ + u:1, /* Supress-suspended interruption */ + z:1, /* Zero condition code */ + e:1, /* Extended control */ + n:1; /* Path no operational */ + u16 __zero:1, + fc:3, /* Function control */ + ac:7, /* Activity control */ + sc:5; /* Status control */ + + /* word 1 */ + u32 addr; /* CCW Address */ + + /* word 2 */ + u8 dev_status; /* Device status */ + u8 sch_status; /* Subchannel status */ + u16 count; /* Count */ +} __attribute__((packed)); + +struct schib { + struct pmcw pmcw; /* Path Management Control Word */ + struct scsw scsw; /* Subchannel Status Word */ + u32 measure_block_1; + u32 measure_block_2; + u32 model_dep_area; +} __attribute__((packed,aligned(4))); + +struct orb { + /* word 0 */ + u32 param; /* Interruption Parameter */ + + /* word 1 */ + u8 key:4, /* Subchannel Key */ + s:1, /* Suspend */ + c:1, /* Streaming-Mode Control */ + m:1, /* Modification Control */ + y:1; /* Synchronization Control */ + u8 f:1, /* Format Control */ + p:1, /* Prefetch Control */ + i:1, /* Initial-Status-Interruption Control */ + a:1, /* Address-Limit-Checking control */ + u:1, /* Suppress-Suspend-Interruption Control */ + __zero1:1, + h:1, /* Format-2-IDAW Control */ + t:1; /* 2K-IDAW Control */ + u8 lpm; /* Logical-Path Mask */ + u8 l:1, /* Incorrect-Length-Suppression Mode */ + d:1, /* Modified-CCW-Indirect-Data-Addressing Control */ + __zero2:5, + x:1; /* ORB-Extension Control */ + + /* word 2 */ + u32 addr; /* Channel-Program Address */ + + /* word 3 */ + u8 css_prio; /* Channel-Subsystem Priority */ + u8 __reserved1; + u8 cu_prio; /* Control-Unit Priority */ + u8 __reserved2; + + /* word 4 - 7 */ + u32 __reserved3; + u32 __reserved4; + u32 __reserved5; + u32 __reserved6; +} __attribute__((packed,aligned(4))); + +struct ccw { + u8 cmd; /* Command code */ + u8 flags; /* Flags */ + u16 count; /* Count */ + u32 addr; /* Data Address */ +} __attribute__((packed,aligned(8))); + +struct psw { + u8 _zero0:1, + r:1, /* PER Mask (R) */ + _zero1:3, + t:1, /* DAT Mode (T) */ + io:1, /* I/O Mask (IO) */ + ex:1; /* External Mask (EX) */ + + u8 key:4, /* Key */ + _zero2:1, + m:1, /* Machine-Check Mask (M) */ + w:1, /* Wait State (W) */ + p:1; /* Problem State (P) */ + + u8 as:2, /* Address-Space Control (AS) */ + cc:2, /* Condition Code (CC) */ + prog_mask:4; /* Program Mask */ + + u8 _zero3:7, + ea:1; /* Extended Addressing (EA) */ + + u32 ba:1, /* Basic Addressing (BA) */ + _zero4:31; + + u64 ptr; +}; + +struct irb { + struct scsw scsw; /* Subchannel-Status */ + u32 w0a, w1a, w2a, w3a, w4a; + u32 w0b, w1b, w2b, w3b, w4b, w5b, w6b, w7b; + u32 w0c, w1c, w2c, w3c, w4c, w5c, w6c, w7c; +} __attribute__((packed,aligned(4))); + +static int init_cons; +static u32 consch; + +static struct irb irb; +static struct orb orb; +static struct ccw ccw; + +static inline int store_sch(u32 sch, struct schib *schib) +{ + int cc; + + asm volatile( + "lr %%r1,%2\n" + "stsch %1\n" + "ipm %0\n" + "srl %0,28\n" + : /* output */ + "=d" (cc), + "=Q" (*schib) + : /* input */ + "d" (sch) + : /* clobbered */ + "cc", "r1", "memory" + ); + + return cc; +} + +static inline int modify_sch(u32 sch, struct schib *schib) +{ + int cc; + + asm volatile( + "lr %%r1,%1\n" + "msch 0(%2)\n" + "ipm %0\n" + "srl %0,28\n" + : /* output */ + "=d" (cc) + : /* input */ + "d" (sch), + "a" (schib) + : /* clobbered */ + "cc", "r1" + ); + + return cc; +} + +static inline int start_sch(u32 sch, struct orb *orb) +{ + int cc; + + asm volatile( + " lr %%r1,%1\n" + " ssch 0(%2)\n" + " ipm %0\n" + " srl %0,28\n" + : /* output */ + "=d" (cc) + : /* input */ + "d" (sch), + "a" (orb) + : /* clobbered */ + "cc", "r1" + ); + + return cc; +} + +#define die() do { \ + asm volatile( \ + "SR %r1, %r1 # not used, but should be zero\n" \ + "SR %r3, %r3 # CPU Address\n" \ + "SIGP %r1, %r3, 0x05 # Signal, order 0x05\n" \ + ); \ + for(;;); \ + } while(0) + +static void enable_cons(int devnum) +{ + struct psw psw; + struct schib schib; + u32 sch; + + for(sch=0x10000; sch<=0x1ffff; sch++) { + if (store_sch(sch, &schib)) + continue; + + if (!schib.pmcw.v) + continue; + + if (schib.pmcw.dev_num != devnum) + continue; + + schib.pmcw.e = 1; + + if (modify_sch(sch, &schib)) + continue; + + // found it + init_cons = 1; + consch = sch; + + // set up the IO interrupt handler + psw.ea = 1; + psw.ba = 1; + + asm volatile( + " larl %%r1,0f\n" + " stg %%r1,%0\n" + " brc 15,1f\n" + /* IO handler code begins */ + "0:\n" + " l %%r1,0xb8\n" + " larl %%r2,irb\n" + " tsch 0(%%r2)\n" + " l %%r1,5(%%r2)\n" + " nill %%r1,0x04\n" + " brc 8,2f\n" // done? + " lg %%r1,0x178\n" // yes. + " bcr 15,%%r1\n" + "2:\n" + " l %%r1,5(%%r2)\n" + " nill %%r1,0x80\n" + " brc 8,3f\n" // attention? + " lg %%r1,0x178\n" // yes. + " bcr 15,%%r1\n" + "3:\n" + " lpswe 0x170\n" + /* IO handler code ends */ + "1:\n" + : /* output */ + "=m" (psw.ptr), + "=m" (irb) + : /* input */ + "a" (&irb) + : /* clobbered */ + "r1", "r2" + ); + + __builtin_memcpy(((void*) 0x1f0), &psw, sizeof(struct psw)); + + return; + } + + die(); +} + +static inline void wait_for_io_int() +{ + struct psw psw; + + __builtin_memset(&psw, 0, sizeof(struct psw)); + psw.io = 1; + psw.ea = 1; + psw.ba = 1; + psw.w = 1; + + asm volatile( + " larl %%r1,0f\n" + " stg %%r1,%0\n" + " lpswe %1\n" + "0:\n" + : /* output */ + "=m" (psw.ptr) + : /* input */ + "m" (psw) + : /* clobbered */ + "r1", "r2" + ); +} + +int putline(char *buf, int len) +{ + char data[CON_LEN]; + + if (!init_cons) + enable_cons(CON_DEV); + + if ((len <= 0) || (len > CON_LEN)) + return -1; + + __builtin_memcpy(data, buf, len); + ascii2ebcdic((u8*) data, len); + + ccw.cmd = 0x01; + ccw.flags = 0; + ccw.count = len; + ccw.addr = (u32) (u64) data; + + __builtin_memset(&orb, 0, sizeof(struct orb)); + orb.lpm = 0xff; + orb.addr = (u32) (u64) &ccw; + orb.f = 1; + + if (start_sch(consch, &orb)) + die(); + + wait_for_io_int(); + + return len; +} + +int getline(char *buf, int len) +{ + if (!init_cons) + enable_cons(CON_DEV); + + if ((len <= 0) || (len > CON_LEN)) + return -1; + + wait_for_io_int(); + + __builtin_memset(buf, 0, CON_LEN); + ccw.cmd = 0x0a; + ccw.flags = 0x20; + ccw.count = len; + ccw.addr = (u32) (u64) buf; + + __builtin_memset(&orb, 0, sizeof(struct orb)); + orb.lpm = 0xff; + orb.addr = (u32) (u64) &ccw; + orb.f = 1; + + if (start_sch(consch, &orb)) + die(); + + wait_for_io_int(); + + for(len=0; len<CON_LEN; len++) + if (!buf[len]) + break; + + if (len) + ebcdic2ascii((u8*) buf, len); + + return len; +}
--- a/src/io.c Fri Feb 25 18:58:43 2011 -0500 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,577 +0,0 @@ -/* - * Tables taken from Linux's arch/s390/kernel/ebcdic.c - */ - -/* - * ASCII (IBM PC 437) -> EBCDIC 037 - */ -static u8 ascii2ebcdic_table[256] = -{ - /*00 NUL SOH STX ETX EOT ENQ ACK BEL */ - 0x00, 0x01, 0x02, 0x03, 0x37, 0x2D, 0x2E, 0x2F, - /*08 BS HT LF VT FF CR SO SI */ - /* ->NL */ - 0x16, 0x05, 0x15, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, - /*10 DLE DC1 DC2 DC3 DC4 NAK SYN ETB */ - 0x10, 0x11, 0x12, 0x13, 0x3C, 0x3D, 0x32, 0x26, - /*18 CAN EM SUB ESC FS GS RS US */ - /* ->IGS ->IRS ->IUS */ - 0x18, 0x19, 0x3F, 0x27, 0x22, 0x1D, 0x1E, 0x1F, - /*20 SP ! " # $ % & ' */ - 0x40, 0x5A, 0x7F, 0x7B, 0x5B, 0x6C, 0x50, 0x7D, - /*28 ( ) * + , - . / */ - 0x4D, 0x5D, 0x5C, 0x4E, 0x6B, 0x60, 0x4B, 0x61, - /*30 0 1 2 3 4 5 6 7 */ - 0xF0, 0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, - /*38 8 9 : ; < = > ? */ - 0xF8, 0xF9, 0x7A, 0x5E, 0x4C, 0x7E, 0x6E, 0x6F, - /*40 @ A B C D E F G */ - 0x7C, 0xC1, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, - /*48 H I J K L M N O */ - 0xC8, 0xC9, 0xD1, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, - /*50 P Q R S T U V W */ - 0xD7, 0xD8, 0xD9, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, - /*58 X Y Z [ \ ] ^ _ */ - 0xE7, 0xE8, 0xE9, 0xBA, 0xE0, 0xBB, 0xB0, 0x6D, - /*60 ` a b c d e f g */ - 0x79, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, - /*68 h i j k l m n o */ - 0x88, 0x89, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, - /*70 p q r s t u v w */ - 0x97, 0x98, 0x99, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, - /*78 x y z { | } ~ DL */ - 0xA7, 0xA8, 0xA9, 0xC0, 0x4F, 0xD0, 0xA1, 0x07, - /*80*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*88*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*90*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*98*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*A0*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*A8*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*B0*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*B8*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*C0*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*C8*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*D0*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*D8*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*E0 sz */ - 0x3F, 0x59, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*E8*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*F0*/ - 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, - /*F8*/ - 0x90, 0x3F, 0x3F, 0x3F, 0x3F, 0xEA, 0x3F, 0xFF -}; - -/* - * EBCDIC 037 -> ASCII (IBM PC 437) - */ -u8 ebcdic2ascii_table[256] = -{ - /* 0x00 NUL SOH STX ETX *SEL HT *RNL DEL */ - 0x00, 0x01, 0x02, 0x03, 0x07, 0x09, 0x07, 0x7F, - /* 0x08 -GE -SPS -RPT VT FF CR SO SI */ - 0x07, 0x07, 0x07, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, - /* 0x10 DLE DC1 DC2 DC3 -RES -NL BS -POC - -ENP ->LF */ - 0x10, 0x11, 0x12, 0x13, 0x07, 0x0A, 0x08, 0x07, - /* 0x18 CAN EM -UBS -CU1 -IFS -IGS -IRS -ITB - -IUS */ - 0x18, 0x19, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07, - /* 0x20 -DS -SOS FS -WUS -BYP LF ETB ESC - -INP */ - 0x07, 0x07, 0x1C, 0x07, 0x07, 0x0A, 0x17, 0x1B, - /* 0x28 -SA -SFE -SM -CSP -MFA ENQ ACK BEL - -SW */ - 0x07, 0x07, 0x07, 0x07, 0x07, 0x05, 0x06, 0x07, - /* 0x30 ---- ---- SYN -IR -PP -TRN -NBS EOT */ - 0x07, 0x07, 0x16, 0x07, 0x07, 0x07, 0x07, 0x04, - /* 0x38 -SBS -IT -RFF -CU3 DC4 NAK ---- SUB */ - 0x07, 0x07, 0x07, 0x07, 0x14, 0x15, 0x07, 0x1A, - /* 0x40 SP RSP ä ---- */ - 0x20, 0xFF, 0x83, 0x84, 0x85, 0xA0, 0x07, 0x86, - /* 0x48 . < ( + | */ - 0x87, 0xA4, 0x9B, 0x2E, 0x3C, 0x28, 0x2B, 0x7C, - /* 0x50 & ---- */ - 0x26, 0x82, 0x88, 0x89, 0x8A, 0xA1, 0x8C, 0x07, - /* 0x58 ß ! $ * ) ; */ - 0x8D, 0xE1, 0x21, 0x24, 0x2A, 0x29, 0x3B, 0xAA, - /* 0x60 - / ---- Ä ---- ---- ---- */ - 0x2D, 0x2F, 0x07, 0x8E, 0x07, 0x07, 0x07, 0x8F, - /* 0x68 ---- , % _ > ? */ - 0x80, 0xA5, 0x07, 0x2C, 0x25, 0x5F, 0x3E, 0x3F, - /* 0x70 ---- ---- ---- ---- ---- ---- ---- */ - 0x07, 0x90, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07, - /* 0x78 * ` : # @ ' = " */ - 0x70, 0x60, 0x3A, 0x23, 0x40, 0x27, 0x3D, 0x22, - /* 0x80 * a b c d e f g */ - 0x07, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67, - /* 0x88 h i ---- ---- ---- */ - 0x68, 0x69, 0xAE, 0xAF, 0x07, 0x07, 0x07, 0xF1, - /* 0x90 ° j k l m n o p */ - 0xF8, 0x6A, 0x6B, 0x6C, 0x6D, 0x6E, 0x6F, 0x70, - /* 0x98 q r ---- ---- */ - 0x71, 0x72, 0xA6, 0xA7, 0x91, 0x07, 0x92, 0x07, - /* 0xA0 ~ s t u v w x */ - 0xE6, 0x7E, 0x73, 0x74, 0x75, 0x76, 0x77, 0x78, - /* 0xA8 y z ---- ---- ---- ---- */ - 0x79, 0x7A, 0xAD, 0xAB, 0x07, 0x07, 0x07, 0x07, - /* 0xB0 ^ ---- § ---- */ - 0x5E, 0x9C, 0x9D, 0xFA, 0x07, 0x07, 0x07, 0xAC, - /* 0xB8 ---- [ ] ---- ---- ---- ---- */ - 0xAB, 0x07, 0x5B, 0x5D, 0x07, 0x07, 0x07, 0x07, - /* 0xC0 { A B C D E F G */ - 0x7B, 0x41, 0x42, 0x43, 0x44, 0x45, 0x46, 0x47, - /* 0xC8 H I ---- ö ---- */ - 0x48, 0x49, 0x07, 0x93, 0x94, 0x95, 0xA2, 0x07, - /* 0xD0 } J K L M N O P */ - 0x7D, 0x4A, 0x4B, 0x4C, 0x4D, 0x4E, 0x4F, 0x50, - /* 0xD8 Q R ---- ü */ - 0x51, 0x52, 0x07, 0x96, 0x81, 0x97, 0xA3, 0x98, - /* 0xE0 \ S T U V W X */ - 0x5C, 0xF6, 0x53, 0x54, 0x55, 0x56, 0x57, 0x58, - /* 0xE8 Y Z ---- Ö ---- ---- ---- */ - 0x59, 0x5A, 0xFD, 0x07, 0x99, 0x07, 0x07, 0x07, - /* 0xF0 0 1 2 3 4 5 6 7 */ - 0x30, 0x31, 0x32, 0x33, 0x34, 0x35, 0x36, 0x37, - /* 0xF8 8 9 ---- ---- Ü ---- ---- ---- */ - 0x38, 0x39, 0x07, 0x07, 0x9A, 0x07, 0x07, 0x07 -}; - -/* - * Generic translate buffer function. - */ -static inline void __translate(u8 *buf, int len, const u8 *table) -{ - asm volatile( - " sr %%r0,%%r0\n" /* test byte = 0 */ - " la %%r2,0(%0)\n" /* buffer */ - " lr %%r3,%2\n" /* length */ - " la %%r4,0(%1)\n" /* table */ - " tre %%r2,%%r4\n" - : /* output */ - : /* input */ - "a" (buf), - "a" (table), - "d" (len) - : /* clobbered */ - "cc", "r0", "r2", "r3", "r4" - ); -} - -#define ascii2ebcdic(buf, len) \ - __translate((buf), (len), ascii2ebcdic_table) -#define ebcdic2ascii(buf, len) \ - __translate((buf), (len), ebcdic2ascii_table) - -/* console I/O functions */ - -#define CON_LEN 132 -#define CON_DEV 0x0009 - -struct pmcw { - /* word 0 */ - u32 interrupt_param; /* Interruption Parameter */ - - /* word 1*/ - u8 __zero1:2, - isc:3, /* I/O-Interruption-Subclass Code */ - __zero2:3; - u8 e:1, /* Enabled */ - lm:2, /* Limit Mode */ - mm:2, /* Measurement-Mode Enable */ - d:1, /* Multipath Mode */ - t:1, /* Timing Facility */ - v:1; /* Device Number Valid */ - u16 dev_num; /* Device Number */ - - /* word 2 */ - u8 lpm; /* Logical-Path Mask */ - u8 pnom; /* Path-Not-Operational Mask */ - u8 lpum; /* Last-Path-Used Mask */ - u8 pim; /* Path-Installed Mask */ - - /* word 3 */ - u16 mbi; /* Measurement-Block Index */ - u8 pom; /* Path-Operational Mask */ - u8 pam; /* Path-Available Mask */ - - /* word 4 & 5 */ - u8 chpid[8]; /* Channel-Path Identifiers */ - - /* word 6 */ - u16 __zero3; - u16 __zero4:13, - f:1, /* Measurement Block Format Control */ - x:1, /* Extended Measurement Word Mode Enable */ - s:1; /* Concurrent Sense */ -}; - -struct scsw { - /* word 0 */ - u16 key:4, /* Subchannel key */ - s:1, /* Suspend control */ - l:1, /* ESW format */ - cc:2, /* Deferred condition code */ - f:1, /* Format */ - p:1, /* Prefetch */ - i:1, /* Initial-status interruption control */ - a:1, /* Address-limit-checking control */ - u:1, /* Supress-suspended interruption */ - z:1, /* Zero condition code */ - e:1, /* Extended control */ - n:1; /* Path no operational */ - u16 __zero:1, - fc:3, /* Function control */ - ac:7, /* Activity control */ - sc:5; /* Status control */ - - /* word 1 */ - u32 addr; /* CCW Address */ - - /* word 2 */ - u8 dev_status; /* Device status */ - u8 sch_status; /* Subchannel status */ - u16 count; /* Count */ -} __attribute__((packed)); - -struct schib { - struct pmcw pmcw; /* Path Management Control Word */ - struct scsw scsw; /* Subchannel Status Word */ - u32 measure_block_1; - u32 measure_block_2; - u32 model_dep_area; -} __attribute__((packed,aligned(4))); - -struct orb { - /* word 0 */ - u32 param; /* Interruption Parameter */ - - /* word 1 */ - u8 key:4, /* Subchannel Key */ - s:1, /* Suspend */ - c:1, /* Streaming-Mode Control */ - m:1, /* Modification Control */ - y:1; /* Synchronization Control */ - u8 f:1, /* Format Control */ - p:1, /* Prefetch Control */ - i:1, /* Initial-Status-Interruption Control */ - a:1, /* Address-Limit-Checking control */ - u:1, /* Suppress-Suspend-Interruption Control */ - __zero1:1, - h:1, /* Format-2-IDAW Control */ - t:1; /* 2K-IDAW Control */ - u8 lpm; /* Logical-Path Mask */ - u8 l:1, /* Incorrect-Length-Suppression Mode */ - d:1, /* Modified-CCW-Indirect-Data-Addressing Control */ - __zero2:5, - x:1; /* ORB-Extension Control */ - - /* word 2 */ - u32 addr; /* Channel-Program Address */ - - /* word 3 */ - u8 css_prio; /* Channel-Subsystem Priority */ - u8 __reserved1; - u8 cu_prio; /* Control-Unit Priority */ - u8 __reserved2; - - /* word 4 - 7 */ - u32 __reserved3; - u32 __reserved4; - u32 __reserved5; - u32 __reserved6; -} __attribute__((packed,aligned(4))); - -struct ccw { - u8 cmd; /* Command code */ - u8 flags; /* Flags */ - u16 count; /* Count */ - u32 addr; /* Data Address */ -} __attribute__((packed,aligned(8))); - -struct psw { - u8 _zero0:1, - r:1, /* PER Mask (R) */ - _zero1:3, - t:1, /* DAT Mode (T) */ - io:1, /* I/O Mask (IO) */ - ex:1; /* External Mask (EX) */ - - u8 key:4, /* Key */ - _zero2:1, - m:1, /* Machine-Check Mask (M) */ - w:1, /* Wait State (W) */ - p:1; /* Problem State (P) */ - - u8 as:2, /* Address-Space Control (AS) */ - cc:2, /* Condition Code (CC) */ - prog_mask:4; /* Program Mask */ - - u8 _zero3:7, - ea:1; /* Extended Addressing (EA) */ - - u32 ba:1, /* Basic Addressing (BA) */ - _zero4:31; - - u64 ptr; -}; - -struct irb { - struct scsw scsw; /* Subchannel-Status */ - u32 w0a, w1a, w2a, w3a, w4a; - u32 w0b, w1b, w2b, w3b, w4b, w5b, w6b, w7b; - u32 w0c, w1c, w2c, w3c, w4c, w5c, w6c, w7c; -} __attribute__((packed,aligned(4))); - -static int init_cons; -static u32 consch; - -static struct irb irb; -static struct orb orb; -static struct ccw ccw; - -static inline int store_sch(u32 sch, struct schib *schib) -{ - int cc; - - asm volatile( - "lr %%r1,%2\n" - "stsch %1\n" - "ipm %0\n" - "srl %0,28\n" - : /* output */ - "=d" (cc), - "=Q" (*schib) - : /* input */ - "d" (sch) - : /* clobbered */ - "cc", "r1", "memory" - ); - - return cc; -} - -static inline int modify_sch(u32 sch, struct schib *schib) -{ - int cc; - - asm volatile( - "lr %%r1,%1\n" - "msch 0(%2)\n" - "ipm %0\n" - "srl %0,28\n" - : /* output */ - "=d" (cc) - : /* input */ - "d" (sch), - "a" (schib) - : /* clobbered */ - "cc", "r1" - ); - - return cc; -} - -static inline int start_sch(u32 sch, struct orb *orb) -{ - int cc; - - asm volatile( - " lr %%r1,%1\n" - " ssch 0(%2)\n" - " ipm %0\n" - " srl %0,28\n" - : /* output */ - "=d" (cc) - : /* input */ - "d" (sch), - "a" (orb) - : /* clobbered */ - "cc", "r1" - ); - - return cc; -} - -#define die() do { \ - asm volatile( \ - "SR %r1, %r1 # not used, but should be zero\n" \ - "SR %r3, %r3 # CPU Address\n" \ - "SIGP %r1, %r3, 0x05 # Signal, order 0x05\n" \ - ); \ - for(;;); \ - } while(0) - -static void enable_cons(int devnum) -{ - struct psw psw; - struct schib schib; - u32 sch; - - for(sch=0x10000; sch<=0x1ffff; sch++) { - if (store_sch(sch, &schib)) - continue; - - if (!schib.pmcw.v) - continue; - - if (schib.pmcw.dev_num != devnum) - continue; - - schib.pmcw.e = 1; - - if (modify_sch(sch, &schib)) - continue; - - // found it - init_cons = 1; - consch = sch; - - // set up the IO interrupt handler - psw.ea = 1; - psw.ba = 1; - - asm volatile( - " larl %%r1,0f\n" - " stg %%r1,%0\n" - " brc 15,1f\n" - /* IO handler code begins */ - "0:\n" - " l %%r1,0xb8\n" - " larl %%r2,irb\n" - " tsch 0(%%r2)\n" - " l %%r1,5(%%r2)\n" - " nill %%r1,0x04\n" - " brc 8,2f\n" // done? - " lg %%r1,0x178\n" // yes. - " bcr 15,%%r1\n" - "2:\n" - " l %%r1,5(%%r2)\n" - " nill %%r1,0x80\n" - " brc 8,3f\n" // attention? - " lg %%r1,0x178\n" // yes. - " bcr 15,%%r1\n" - "3:\n" - " lpswe 0x170\n" - /* IO handler code ends */ - "1:\n" - : /* output */ - "=m" (psw.ptr), - "=m" (irb) - : /* input */ - "a" (&irb) - : /* clobbered */ - "r1", "r2" - ); - - __builtin_memcpy(((void*) 0x1f0), &psw, sizeof(struct psw)); - - return; - } - - die(); -} - -static inline void wait_for_io_int() -{ - struct psw psw; - - __builtin_memset(&psw, 0, sizeof(struct psw)); - psw.io = 1; - psw.ea = 1; - psw.ba = 1; - psw.w = 1; - - asm volatile( - " larl %%r1,0f\n" - " stg %%r1,%0\n" - " lpswe %1\n" - "0:\n" - : /* output */ - "=m" (psw.ptr) - : /* input */ - "m" (psw) - : /* clobbered */ - "r1", "r2" - ); -} - -int putline(char *buf, int len) -{ - char data[CON_LEN]; - - if (!init_cons) - enable_cons(CON_DEV); - - if ((len <= 0) || (len > CON_LEN)) - return -1; - - __builtin_memcpy(data, buf, len); - ascii2ebcdic((u8*) data, len); - - ccw.cmd = 0x01; - ccw.flags = 0; - ccw.count = len; - ccw.addr = (u32) (u64) data; - - __builtin_memset(&orb, 0, sizeof(struct orb)); - orb.lpm = 0xff; - orb.addr = (u32) (u64) &ccw; - orb.f = 1; - - if (start_sch(consch, &orb)) - die(); - - wait_for_io_int(); - - return len; -} - -int getline(char *buf, int len) -{ - if (!init_cons) - enable_cons(CON_DEV); - - if ((len <= 0) || (len > CON_LEN)) - return -1; - - wait_for_io_int(); - - __builtin_memset(buf, 0, CON_LEN); - ccw.cmd = 0x0a; - ccw.flags = 0x20; - ccw.count = len; - ccw.addr = (u32) (u64) buf; - - __builtin_memset(&orb, 0, sizeof(struct orb)); - orb.lpm = 0xff; - orb.addr = (u32) (u64) &ccw; - orb.f = 1; - - if (start_sch(consch, &orb)) - die(); - - wait_for_io_int(); - - for(len=0; len<CON_LEN; len++) - if (!buf[len]) - break; - - if (len) - ebcdic2ascii((u8*) buf, len); - - return len; -}