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> 1467bee4eeSJanosch Frank #include <asm/arch_def.h> 1567bee4eeSJanosch Frank #include <asm/io.h> 16*04a401ddSJanosch Frank #include <asm/spinlock.h> 177ed7df23SJanosch Frank #include "sclp.h" 187ed7df23SJanosch Frank 1967bee4eeSJanosch Frank /* 2067bee4eeSJanosch Frank * ASCII (IBM PC 437) -> EBCDIC 037 2167bee4eeSJanosch Frank */ 2267bee4eeSJanosch Frank static uint8_t _ascebc[256] = { 2367bee4eeSJanosch Frank /*00 NUL SOH STX ETX EOT ENQ ACK BEL */ 2467bee4eeSJanosch Frank 0x00, 0x01, 0x02, 0x03, 0x37, 0x2D, 0x2E, 0x2F, 2567bee4eeSJanosch Frank /*08 BS HT LF VT FF CR SO SI */ 2667bee4eeSJanosch Frank /* ->NL */ 2767bee4eeSJanosch Frank 0x16, 0x05, 0x15, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, 2867bee4eeSJanosch Frank /*10 DLE DC1 DC2 DC3 DC4 NAK SYN ETB */ 2967bee4eeSJanosch Frank 0x10, 0x11, 0x12, 0x13, 0x3C, 0x3D, 0x32, 0x26, 3067bee4eeSJanosch Frank /*18 CAN EM SUB ESC FS GS RS US */ 3167bee4eeSJanosch Frank /* ->IGS ->IRS ->IUS */ 3267bee4eeSJanosch Frank 0x18, 0x19, 0x3F, 0x27, 0x22, 0x1D, 0x1E, 0x1F, 3367bee4eeSJanosch Frank /*20 SP ! " # $ % & ' */ 3467bee4eeSJanosch Frank 0x40, 0x5A, 0x7F, 0x7B, 0x5B, 0x6C, 0x50, 0x7D, 3567bee4eeSJanosch Frank /*28 ( ) * + , - . / */ 3667bee4eeSJanosch Frank 0x4D, 0x5D, 0x5C, 0x4E, 0x6B, 0x60, 0x4B, 0x61, 3767bee4eeSJanosch Frank /*30 0 1 2 3 4 5 6 7 */ 3867bee4eeSJanosch Frank 0xF0, 0xF1, 0xF2, 0xF3, 0xF4, 0xF5, 0xF6, 0xF7, 3967bee4eeSJanosch Frank /*38 8 9 : ; < = > ? */ 4067bee4eeSJanosch Frank 0xF8, 0xF9, 0x7A, 0x5E, 0x4C, 0x7E, 0x6E, 0x6F, 4167bee4eeSJanosch Frank /*40 @ A B C D E F G */ 4267bee4eeSJanosch Frank 0x7C, 0xC1, 0xC2, 0xC3, 0xC4, 0xC5, 0xC6, 0xC7, 4367bee4eeSJanosch Frank /*48 H I J K L M N O */ 4467bee4eeSJanosch Frank 0xC8, 0xC9, 0xD1, 0xD2, 0xD3, 0xD4, 0xD5, 0xD6, 4567bee4eeSJanosch Frank /*50 P Q R S T U V W */ 4667bee4eeSJanosch Frank 0xD7, 0xD8, 0xD9, 0xE2, 0xE3, 0xE4, 0xE5, 0xE6, 4767bee4eeSJanosch Frank /*58 X Y Z [ \ ] ^ _ */ 4867bee4eeSJanosch Frank 0xE7, 0xE8, 0xE9, 0xBA, 0xE0, 0xBB, 0xB0, 0x6D, 4967bee4eeSJanosch Frank /*60 ` a b c d e f g */ 5067bee4eeSJanosch Frank 0x79, 0x81, 0x82, 0x83, 0x84, 0x85, 0x86, 0x87, 5167bee4eeSJanosch Frank /*68 h i j k l m n o */ 5267bee4eeSJanosch Frank 0x88, 0x89, 0x91, 0x92, 0x93, 0x94, 0x95, 0x96, 5367bee4eeSJanosch Frank /*70 p q r s t u v w */ 5467bee4eeSJanosch Frank 0x97, 0x98, 0x99, 0xA2, 0xA3, 0xA4, 0xA5, 0xA6, 5567bee4eeSJanosch Frank /*78 x y z { | } ~ DL */ 5667bee4eeSJanosch Frank 0xA7, 0xA8, 0xA9, 0xC0, 0x4F, 0xD0, 0xA1, 0x07, 5767bee4eeSJanosch Frank /*80*/ 5867bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 5967bee4eeSJanosch Frank /*88*/ 6067bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 6167bee4eeSJanosch Frank /*90*/ 6267bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 6367bee4eeSJanosch Frank /*98*/ 6467bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 6567bee4eeSJanosch Frank /*A0*/ 6667bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 6767bee4eeSJanosch Frank /*A8*/ 6867bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 6967bee4eeSJanosch Frank /*B0*/ 7067bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 7167bee4eeSJanosch Frank /*B8*/ 7267bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 7367bee4eeSJanosch Frank /*C0*/ 7467bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 7567bee4eeSJanosch Frank /*C8*/ 7667bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 7767bee4eeSJanosch Frank /*D0*/ 7867bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 7967bee4eeSJanosch Frank /*D8*/ 8067bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 8167bee4eeSJanosch Frank /*E0 sz */ 8267bee4eeSJanosch Frank 0x3F, 0x59, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 8367bee4eeSJanosch Frank /*E8*/ 8467bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 8567bee4eeSJanosch Frank /*F0*/ 8667bee4eeSJanosch Frank 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 8767bee4eeSJanosch Frank /*F8*/ 8867bee4eeSJanosch Frank 0x90, 0x3F, 0x3F, 0x3F, 0x3F, 0xEA, 0x3F, 0xFF 8967bee4eeSJanosch Frank }; 9067bee4eeSJanosch Frank 91*04a401ddSJanosch Frank static char lm_buff[120]; 92*04a401ddSJanosch Frank static unsigned char lm_buff_off; 93*04a401ddSJanosch Frank static struct spinlock lm_buff_lock; 94*04a401ddSJanosch Frank 9567bee4eeSJanosch Frank static void sclp_print_ascii(const char *str) 9667bee4eeSJanosch Frank { 9767bee4eeSJanosch Frank int len = strlen(str); 9867bee4eeSJanosch Frank WriteEventData *sccb = (void *)_sccb; 9967bee4eeSJanosch Frank 10067bee4eeSJanosch Frank sclp_mark_busy(); 10167bee4eeSJanosch Frank memset(sccb, 0, sizeof(*sccb)); 10267bee4eeSJanosch Frank sccb->h.length = offsetof(WriteEventData, msg) + len; 10367bee4eeSJanosch Frank sccb->h.function_code = SCLP_FC_NORMAL_WRITE; 10467bee4eeSJanosch Frank sccb->ebh.length = sizeof(EventBufferHeader) + len; 10567bee4eeSJanosch Frank sccb->ebh.type = SCLP_EVENT_ASCII_CONSOLE_DATA; 10667bee4eeSJanosch Frank memcpy(&sccb->msg, str, len); 10767bee4eeSJanosch Frank 10867bee4eeSJanosch Frank sclp_service_call(SCLP_CMD_WRITE_EVENT_DATA, sccb); 10967bee4eeSJanosch Frank } 11067bee4eeSJanosch Frank 111*04a401ddSJanosch Frank static void lm_print(const char *buff, int len) 11267bee4eeSJanosch Frank { 11367bee4eeSJanosch Frank unsigned char *ptr, *end, ch; 114*04a401ddSJanosch Frank unsigned int count, offset; 11567bee4eeSJanosch Frank struct WriteEventData *sccb; 11667bee4eeSJanosch Frank struct mdb *mdb; 11767bee4eeSJanosch Frank struct mto *mto; 11867bee4eeSJanosch Frank struct go *go; 11967bee4eeSJanosch Frank 12067bee4eeSJanosch Frank sclp_mark_busy(); 12167bee4eeSJanosch Frank sccb = (struct WriteEventData *) _sccb; 12267bee4eeSJanosch Frank end = (unsigned char *) sccb + 4096 - 1; 12367bee4eeSJanosch Frank memset(sccb, 0, sizeof(*sccb)); 12467bee4eeSJanosch Frank ptr = (unsigned char *) &sccb->msg.mdb.mto; 12567bee4eeSJanosch Frank offset = 0; 12667bee4eeSJanosch Frank do { 12767bee4eeSJanosch Frank for (count = sizeof(*mto); offset < len; count++) { 128*04a401ddSJanosch Frank ch = buff[offset++]; 12967bee4eeSJanosch Frank if (ch == 0x0a || ptr + count > end) 13067bee4eeSJanosch Frank break; 13167bee4eeSJanosch Frank ptr[count] = _ascebc[ch]; 13267bee4eeSJanosch Frank } 13367bee4eeSJanosch Frank mto = (struct mto *) ptr; 13467bee4eeSJanosch Frank mto->length = count; 13567bee4eeSJanosch Frank mto->type = 4; 13667bee4eeSJanosch Frank mto->line_type_flags = LNTPFLGS_ENDTEXT; 13767bee4eeSJanosch Frank ptr += count; 13867bee4eeSJanosch Frank } while (offset < len && ptr + sizeof(*mto) <= end); 13967bee4eeSJanosch Frank len = ptr - (unsigned char *) sccb; 14067bee4eeSJanosch Frank sccb->h.length = len - offsetof(struct WriteEventData, h); 14167bee4eeSJanosch Frank sccb->h.function_code = SCLP_FC_NORMAL_WRITE; 14267bee4eeSJanosch Frank sccb->ebh.type = EVTYP_MSG; 14367bee4eeSJanosch Frank sccb->ebh.length = len - offsetof(struct WriteEventData, ebh); 14467bee4eeSJanosch Frank mdb = &sccb->msg.mdb; 14567bee4eeSJanosch Frank mdb->header.type = 1; 14667bee4eeSJanosch Frank mdb->header.tag = 0xD4C4C240; 14767bee4eeSJanosch Frank mdb->header.revision_code = 1; 14867bee4eeSJanosch Frank mdb->header.length = len - offsetof(struct WriteEventData, msg.mdb.header); 14967bee4eeSJanosch Frank go = &mdb->go; 15067bee4eeSJanosch Frank go->length = sizeof(*go); 15167bee4eeSJanosch Frank go->type = 1; 15267bee4eeSJanosch Frank sclp_service_call(SCLP_CMD_WRITE_EVENT_DATA, sccb); 15367bee4eeSJanosch Frank } 15467bee4eeSJanosch Frank 155*04a401ddSJanosch Frank 156*04a401ddSJanosch Frank /* 157*04a401ddSJanosch Frank * In contrast to the ascii console, linemode produces a new 158*04a401ddSJanosch Frank * line with every write of data. The report() function uses 159*04a401ddSJanosch Frank * several printf() calls to generate a line of data which 160*04a401ddSJanosch Frank * would all end up on different lines. 161*04a401ddSJanosch Frank * 162*04a401ddSJanosch Frank * Hence we buffer here until we encounter a \n or the buffer 163*04a401ddSJanosch Frank * is full. That means that linemode output can look a bit 164*04a401ddSJanosch Frank * different from ascii and that it takes a bit longer for 165*04a401ddSJanosch Frank * lines to appear. 166*04a401ddSJanosch Frank */ 167*04a401ddSJanosch Frank static void sclp_print_lm(const char *str) 168*04a401ddSJanosch Frank { 169*04a401ddSJanosch Frank int i; 170*04a401ddSJanosch Frank const int len = strlen(str); 171*04a401ddSJanosch Frank 172*04a401ddSJanosch Frank spin_lock(&lm_buff_lock); 173*04a401ddSJanosch Frank 174*04a401ddSJanosch Frank for (i = 0; i < len; i++) { 175*04a401ddSJanosch Frank lm_buff[lm_buff_off++] = str[i]; 176*04a401ddSJanosch Frank 177*04a401ddSJanosch Frank /* Buffer full or newline? */ 178*04a401ddSJanosch Frank if (str[i] == '\n' || lm_buff_off == (ARRAY_SIZE(lm_buff) - 1)) { 179*04a401ddSJanosch Frank lm_print(lm_buff, lm_buff_off); 180*04a401ddSJanosch Frank lm_buff_off = 0; 181*04a401ddSJanosch Frank } 182*04a401ddSJanosch Frank } 183*04a401ddSJanosch Frank spin_unlock(&lm_buff_lock); 184*04a401ddSJanosch Frank } 185*04a401ddSJanosch Frank 18667bee4eeSJanosch Frank /* 18767bee4eeSJanosch Frank * SCLP needs to be initialized by setting a send and receive mask, 18867bee4eeSJanosch Frank * indicating which messages the control program (we) want(s) to 18967bee4eeSJanosch Frank * send/receive. 19067bee4eeSJanosch Frank */ 1917ed7df23SJanosch Frank static void sclp_set_write_mask(void) 1927ed7df23SJanosch Frank { 1937ed7df23SJanosch Frank WriteEventMask *sccb = (void *)_sccb; 1947ed7df23SJanosch Frank 1958ead801eSJanosch Frank sclp_mark_busy(); 19667bee4eeSJanosch Frank memset(_sccb, 0, sizeof(*sccb)); 1977ed7df23SJanosch Frank sccb->h.length = sizeof(WriteEventMask); 19867bee4eeSJanosch Frank sccb->h.function_code = SCLP_FC_NORMAL_WRITE; 19967bee4eeSJanosch Frank sccb->mask_length = sizeof(sccb_mask_t); 20067bee4eeSJanosch Frank 20167bee4eeSJanosch Frank /* For now we don't process sclp input. */ 20267bee4eeSJanosch Frank sccb->cp_receive_mask = 0; 20367bee4eeSJanosch Frank /* We send ASCII and line mode. */ 20467bee4eeSJanosch Frank sccb->cp_send_mask = SCLP_EVENT_MASK_MSG_ASCII | SCLP_EVENT_MASK_MSG; 2057ed7df23SJanosch Frank 2067ed7df23SJanosch Frank sclp_service_call(SCLP_CMD_WRITE_EVENT_MASK, sccb); 20767bee4eeSJanosch Frank assert(sccb->h.response_code == SCLP_RC_NORMAL_COMPLETION); 2087ed7df23SJanosch Frank } 2097ed7df23SJanosch Frank 2107ed7df23SJanosch Frank void sclp_console_setup(void) 2117ed7df23SJanosch Frank { 2127ed7df23SJanosch Frank sclp_set_write_mask(); 2137ed7df23SJanosch Frank } 2147ed7df23SJanosch Frank 2157ed7df23SJanosch Frank void sclp_print(const char *str) 2167ed7df23SJanosch Frank { 21767bee4eeSJanosch Frank /* 21867bee4eeSJanosch Frank * z/VM advertises a vt220 console which is not functional: 21967bee4eeSJanosch Frank * (response code 05F0, "not active because of the state of 22067bee4eeSJanosch Frank * the machine"). Hence testing the masks would only work if 22167bee4eeSJanosch Frank * we also use stsi data to distinguish z/VM. 22267bee4eeSJanosch Frank * 22367bee4eeSJanosch Frank * Let's rather print on all available consoles. 22467bee4eeSJanosch Frank */ 22567bee4eeSJanosch Frank if (strlen(str) > (PAGE_SIZE / 2)) { 22667bee4eeSJanosch Frank sclp_print_ascii("Warning: Printing is limited to 2KB of data."); 22767bee4eeSJanosch Frank sclp_print_lm("Warning: Printing is limited to 2KB of data."); 22867bee4eeSJanosch Frank return; 22967bee4eeSJanosch Frank } 23067bee4eeSJanosch Frank sclp_print_ascii(str); 23167bee4eeSJanosch Frank sclp_print_lm(str); 2327ed7df23SJanosch Frank } 233