17ed7df23SJanosch Frank /* 27ed7df23SJanosch Frank * SCLP ASCII access driver 37ed7df23SJanosch Frank * 47ed7df23SJanosch Frank * Copyright (c) 2013 Alexander Graf <agraf@suse.de> 57ed7df23SJanosch Frank * 67ed7df23SJanosch Frank * This work is licensed under the terms of the GNU GPL, version 2 or (at 77ed7df23SJanosch Frank * your option) any later version. See the COPYING file in the top-level 87ed7df23SJanosch Frank * directory. 97ed7df23SJanosch Frank */ 107ed7df23SJanosch Frank 117ed7df23SJanosch Frank #include <libcflat.h> 127ed7df23SJanosch Frank #include <string.h> 137ed7df23SJanosch Frank #include <asm/page.h> 14*67bee4eeSJanosch Frank #include <asm/arch_def.h> 15*67bee4eeSJanosch Frank #include <asm/io.h> 167ed7df23SJanosch Frank #include "sclp.h" 177ed7df23SJanosch Frank 18*67bee4eeSJanosch Frank /* 19*67bee4eeSJanosch Frank * ASCII (IBM PC 437) -> EBCDIC 037 20*67bee4eeSJanosch Frank */ 21*67bee4eeSJanosch Frank static uint8_t _ascebc[256] = { 22*67bee4eeSJanosch Frank /*00 NUL SOH STX ETX EOT ENQ ACK BEL */ 23*67bee4eeSJanosch Frank 0x00, 0x01, 0x02, 0x03, 0x37, 0x2D, 0x2E, 0x2F, 24*67bee4eeSJanosch Frank /*08 BS HT LF VT FF CR SO SI */ 25*67bee4eeSJanosch Frank /* ->NL */ 26*67bee4eeSJanosch Frank 0x16, 0x05, 0x15, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, 27*67bee4eeSJanosch Frank /*10 DLE DC1 DC2 DC3 DC4 NAK SYN ETB */ 28*67bee4eeSJanosch Frank 0x10, 0x11, 0x12, 0x13, 0x3C, 0x3D, 0x32, 0x26, 29*67bee4eeSJanosch Frank /*18 CAN EM SUB ESC FS GS RS US */ 30*67bee4eeSJanosch Frank /* ->IGS ->IRS ->IUS */ 31*67bee4eeSJanosch Frank 0x18, 0x19, 0x3F, 0x27, 0x22, 0x1D, 0x1E, 0x1F, 32*67bee4eeSJanosch Frank /*20 SP ! " # $ % & ' */ 33*67bee4eeSJanosch Frank 0x40, 0x5A, 0x7F, 0x7B, 0x5B, 0x6C, 0x50, 0x7D, 34*67bee4eeSJanosch Frank /*28 ( ) * + , - . / */ 35*67bee4eeSJanosch Frank 0x4D, 0x5D, 0x5C, 0x4E, 0x6B, 0x60, 0x4B, 0x61, 36*67bee4eeSJanosch Frank /*30 0 1 2 3 4 5 6 7 */ 37*67bee4eeSJanosch Frank 0xF0, 0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, 38*67bee4eeSJanosch Frank /*38 8 9 : ; < = > ? */ 39*67bee4eeSJanosch Frank 0xF8, 0xF9, 0x7A, 0x5E, 0x4C, 0x7E, 0x6E, 0x6F, 40*67bee4eeSJanosch Frank /*40 @ A B C D E F G */ 41*67bee4eeSJanosch Frank 0x7C, 0xC1, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, 42*67bee4eeSJanosch Frank /*48 H I J K L M N O */ 43*67bee4eeSJanosch Frank 0xC8, 0xC9, 0xD1, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, 44*67bee4eeSJanosch Frank /*50 P Q R S T U V W */ 45*67bee4eeSJanosch Frank 0xD7, 0xD8, 0xD9, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, 46*67bee4eeSJanosch Frank /*58 X Y Z [ \ ] ^ _ */ 47*67bee4eeSJanosch Frank 0xE7, 0xE8, 0xE9, 0xBA, 0xE0, 0xBB, 0xB0, 0x6D, 48*67bee4eeSJanosch Frank /*60 ` a b c d e f g */ 49*67bee4eeSJanosch Frank 0x79, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, 50*67bee4eeSJanosch Frank /*68 h i j k l m n o */ 51*67bee4eeSJanosch Frank 0x88, 0x89, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 52*67bee4eeSJanosch Frank /*70 p q r s t u v w */ 53*67bee4eeSJanosch Frank 0x97, 0x98, 0x99, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 54*67bee4eeSJanosch Frank /*78 x y z { | } ~ DL */ 55*67bee4eeSJanosch Frank 0xA7, 0xA8, 0xA9, 0xC0, 0x4F, 0xD0, 0xA1, 0x07, 56*67bee4eeSJanosch Frank /*80*/ 57*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 58*67bee4eeSJanosch Frank /*88*/ 59*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 60*67bee4eeSJanosch Frank /*90*/ 61*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 62*67bee4eeSJanosch Frank /*98*/ 63*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 64*67bee4eeSJanosch Frank /*A0*/ 65*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 66*67bee4eeSJanosch Frank /*A8*/ 67*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 68*67bee4eeSJanosch Frank /*B0*/ 69*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 70*67bee4eeSJanosch Frank /*B8*/ 71*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 72*67bee4eeSJanosch Frank /*C0*/ 73*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 74*67bee4eeSJanosch Frank /*C8*/ 75*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 76*67bee4eeSJanosch Frank /*D0*/ 77*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 78*67bee4eeSJanosch Frank /*D8*/ 79*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 80*67bee4eeSJanosch Frank /*E0 sz */ 81*67bee4eeSJanosch Frank 0x3F, 0x59, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 82*67bee4eeSJanosch Frank /*E8*/ 83*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 84*67bee4eeSJanosch Frank /*F0*/ 85*67bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 86*67bee4eeSJanosch Frank /*F8*/ 87*67bee4eeSJanosch Frank 0x90, 0x3F, 0x3F, 0x3F, 0x3F, 0xEA, 0x3F, 0xFF 88*67bee4eeSJanosch Frank }; 89*67bee4eeSJanosch Frank 90*67bee4eeSJanosch Frank static void sclp_print_ascii(const char *str) 91*67bee4eeSJanosch Frank { 92*67bee4eeSJanosch Frank int len = strlen(str); 93*67bee4eeSJanosch Frank WriteEventData *sccb = (void *)_sccb; 94*67bee4eeSJanosch Frank 95*67bee4eeSJanosch Frank sclp_mark_busy(); 96*67bee4eeSJanosch Frank memset(sccb, 0, sizeof(*sccb)); 97*67bee4eeSJanosch Frank sccb->h.length = offsetof(WriteEventData, msg) + len; 98*67bee4eeSJanosch Frank sccb->h.function_code = SCLP_FC_NORMAL_WRITE; 99*67bee4eeSJanosch Frank sccb->ebh.length = sizeof(EventBufferHeader) + len; 100*67bee4eeSJanosch Frank sccb->ebh.type = SCLP_EVENT_ASCII_CONSOLE_DATA; 101*67bee4eeSJanosch Frank memcpy(&sccb->msg, str, len); 102*67bee4eeSJanosch Frank 103*67bee4eeSJanosch Frank sclp_service_call(SCLP_CMD_WRITE_EVENT_DATA, sccb); 104*67bee4eeSJanosch Frank } 105*67bee4eeSJanosch Frank 106*67bee4eeSJanosch Frank static void sclp_print_lm(const char *str) 107*67bee4eeSJanosch Frank { 108*67bee4eeSJanosch Frank unsigned char *ptr, *end, ch; 109*67bee4eeSJanosch Frank unsigned int count, offset, len; 110*67bee4eeSJanosch Frank struct WriteEventData *sccb; 111*67bee4eeSJanosch Frank struct mdb *mdb; 112*67bee4eeSJanosch Frank struct mto *mto; 113*67bee4eeSJanosch Frank struct go *go; 114*67bee4eeSJanosch Frank 115*67bee4eeSJanosch Frank sclp_mark_busy(); 116*67bee4eeSJanosch Frank sccb = (struct WriteEventData *) _sccb; 117*67bee4eeSJanosch Frank end = (unsigned char *) sccb + 4096 - 1; 118*67bee4eeSJanosch Frank memset(sccb, 0, sizeof(*sccb)); 119*67bee4eeSJanosch Frank ptr = (unsigned char *) &sccb->msg.mdb.mto; 120*67bee4eeSJanosch Frank len = strlen(str); 121*67bee4eeSJanosch Frank offset = 0; 122*67bee4eeSJanosch Frank do { 123*67bee4eeSJanosch Frank for (count = sizeof(*mto); offset < len; count++) { 124*67bee4eeSJanosch Frank ch = str[offset++]; 125*67bee4eeSJanosch Frank if (ch == 0x0a || ptr + count > end) 126*67bee4eeSJanosch Frank break; 127*67bee4eeSJanosch Frank ptr[count] = _ascebc[ch]; 128*67bee4eeSJanosch Frank } 129*67bee4eeSJanosch Frank mto = (struct mto *) ptr; 130*67bee4eeSJanosch Frank mto->length = count; 131*67bee4eeSJanosch Frank mto->type = 4; 132*67bee4eeSJanosch Frank mto->line_type_flags = LNTPFLGS_ENDTEXT; 133*67bee4eeSJanosch Frank ptr += count; 134*67bee4eeSJanosch Frank } while (offset < len && ptr + sizeof(*mto) <= end); 135*67bee4eeSJanosch Frank len = ptr - (unsigned char *) sccb; 136*67bee4eeSJanosch Frank sccb->h.length = len - offsetof(struct WriteEventData, h); 137*67bee4eeSJanosch Frank sccb->h.function_code = SCLP_FC_NORMAL_WRITE; 138*67bee4eeSJanosch Frank sccb->ebh.type = EVTYP_MSG; 139*67bee4eeSJanosch Frank sccb->ebh.length = len - offsetof(struct WriteEventData, ebh); 140*67bee4eeSJanosch Frank mdb = &sccb->msg.mdb; 141*67bee4eeSJanosch Frank mdb->header.type = 1; 142*67bee4eeSJanosch Frank mdb->header.tag = 0xD4C4C240; 143*67bee4eeSJanosch Frank mdb->header.revision_code = 1; 144*67bee4eeSJanosch Frank mdb->header.length = len - offsetof(struct WriteEventData, msg.mdb.header); 145*67bee4eeSJanosch Frank go = &mdb->go; 146*67bee4eeSJanosch Frank go->length = sizeof(*go); 147*67bee4eeSJanosch Frank go->type = 1; 148*67bee4eeSJanosch Frank sclp_service_call(SCLP_CMD_WRITE_EVENT_DATA, sccb); 149*67bee4eeSJanosch Frank } 150*67bee4eeSJanosch Frank 151*67bee4eeSJanosch Frank /* 152*67bee4eeSJanosch Frank * SCLP needs to be initialized by setting a send and receive mask, 153*67bee4eeSJanosch Frank * indicating which messages the control program (we) want(s) to 154*67bee4eeSJanosch Frank * send/receive. 155*67bee4eeSJanosch Frank */ 1567ed7df23SJanosch Frank static void sclp_set_write_mask(void) 1577ed7df23SJanosch Frank { 1587ed7df23SJanosch Frank WriteEventMask *sccb = (void *)_sccb; 1597ed7df23SJanosch Frank 1608ead801eSJanosch Frank sclp_mark_busy(); 161*67bee4eeSJanosch Frank memset(_sccb, 0, sizeof(*sccb)); 1627ed7df23SJanosch Frank sccb->h.length = sizeof(WriteEventMask); 163*67bee4eeSJanosch Frank sccb->h.function_code = SCLP_FC_NORMAL_WRITE; 164*67bee4eeSJanosch Frank sccb->mask_length = sizeof(sccb_mask_t); 165*67bee4eeSJanosch Frank 166*67bee4eeSJanosch Frank /* For now we don't process sclp input. */ 167*67bee4eeSJanosch Frank sccb->cp_receive_mask = 0; 168*67bee4eeSJanosch Frank /* We send ASCII and line mode. */ 169*67bee4eeSJanosch Frank sccb->cp_send_mask = SCLP_EVENT_MASK_MSG_ASCII | SCLP_EVENT_MASK_MSG; 1707ed7df23SJanosch Frank 1717ed7df23SJanosch Frank sclp_service_call(SCLP_CMD_WRITE_EVENT_MASK, sccb); 172*67bee4eeSJanosch Frank assert(sccb->h.response_code == SCLP_RC_NORMAL_COMPLETION); 1737ed7df23SJanosch Frank } 1747ed7df23SJanosch Frank 1757ed7df23SJanosch Frank void sclp_console_setup(void) 1767ed7df23SJanosch Frank { 1777ed7df23SJanosch Frank sclp_set_write_mask(); 1787ed7df23SJanosch Frank } 1797ed7df23SJanosch Frank 1807ed7df23SJanosch Frank void sclp_print(const char *str) 1817ed7df23SJanosch Frank { 182*67bee4eeSJanosch Frank /* 183*67bee4eeSJanosch Frank * z/VM advertises a vt220 console which is not functional: 184*67bee4eeSJanosch Frank * (response code 05F0, "not active because of the state of 185*67bee4eeSJanosch Frank * the machine"). Hence testing the masks would only work if 186*67bee4eeSJanosch Frank * we also use stsi data to distinguish z/VM. 187*67bee4eeSJanosch Frank * 188*67bee4eeSJanosch Frank * Let's rather print on all available consoles. 189*67bee4eeSJanosch Frank */ 190*67bee4eeSJanosch Frank if (strlen(str) > (PAGE_SIZE / 2)) { 191*67bee4eeSJanosch Frank sclp_print_ascii("Warning: Printing is limited to 2KB of data."); 192*67bee4eeSJanosch Frank sclp_print_lm("Warning: Printing is limited to 2KB of data."); 193*67bee4eeSJanosch Frank return; 194*67bee4eeSJanosch Frank } 195*67bee4eeSJanosch Frank sclp_print_ascii(str); 196*67bee4eeSJanosch Frank sclp_print_lm(str); 1977ed7df23SJanosch Frank } 198