428 lines
12 KiB
C
428 lines
12 KiB
C
/*
|
|
* S390 Channel I/O
|
|
*
|
|
* Copyright (c) 2013 Alexander Graf <agraf@suse.de>
|
|
* Copyright (c) 2019 IBM Corp.
|
|
*
|
|
* Author(s): Jason J. Herne <jjherne@us.ibm.com>
|
|
*
|
|
* This work is licensed under the terms of the GNU GPL, version 2 or (at
|
|
* your option) any later version. See the COPYING file in the top-level
|
|
* directory.
|
|
*/
|
|
|
|
#include "libc.h"
|
|
#include "s390-ccw.h"
|
|
#include "s390-arch.h"
|
|
#include "helper.h"
|
|
#include "cio.h"
|
|
|
|
static char chsc_page[PAGE_SIZE] __attribute__((__aligned__(PAGE_SIZE)));
|
|
|
|
static int __do_cio(SubChannelId schid, uint32_t ccw_addr, int fmt, Irb *irb);
|
|
|
|
int enable_mss_facility(void)
|
|
{
|
|
int ret;
|
|
ChscAreaSda *sda_area = (ChscAreaSda *) chsc_page;
|
|
|
|
memset(sda_area, 0, PAGE_SIZE);
|
|
sda_area->request.length = 0x0400;
|
|
sda_area->request.code = 0x0031;
|
|
sda_area->operation_code = 0x2;
|
|
|
|
ret = chsc(sda_area);
|
|
if ((ret == 0) && (sda_area->response.code == 0x0001)) {
|
|
return 0;
|
|
}
|
|
return -EIO;
|
|
}
|
|
|
|
void enable_subchannel(SubChannelId schid)
|
|
{
|
|
Schib schib;
|
|
|
|
stsch_err(schid, &schib);
|
|
schib.pmcw.ena = 1;
|
|
msch(schid, &schib);
|
|
}
|
|
|
|
uint16_t cu_type(SubChannelId schid)
|
|
{
|
|
SenseId sense_data;
|
|
Ccw1 sense_id_ccw = {
|
|
.cmd_code = CCW_CMD_SENSE_ID,
|
|
.flags = CCW_FLAG_SLI,
|
|
.count = sizeof(sense_data),
|
|
.cda = ptr2u32(&sense_data),
|
|
};
|
|
|
|
if (do_cio(schid, CU_TYPE_UNKNOWN, ptr2u32(&sense_id_ccw), CCW_FMT1)) {
|
|
panic("Failed to run SenseID CCw\n");
|
|
}
|
|
|
|
return sense_data.cu_type;
|
|
}
|
|
|
|
int basic_sense(SubChannelId schid, uint16_t cutype, void *sense_data,
|
|
uint16_t data_size)
|
|
{
|
|
Ccw1 senseCcw = {
|
|
.cmd_code = CCW_CMD_BASIC_SENSE,
|
|
.count = data_size,
|
|
.cda = ptr2u32(sense_data),
|
|
};
|
|
Irb irb;
|
|
|
|
return __do_cio(schid, ptr2u32(&senseCcw), CCW_FMT1, &irb);
|
|
}
|
|
|
|
static bool irb_error(Irb *irb)
|
|
{
|
|
if (irb->scsw.cstat) {
|
|
return true;
|
|
}
|
|
return irb->scsw.dstat != (SCSW_DSTAT_DEVEND | SCSW_DSTAT_CHEND);
|
|
}
|
|
|
|
static void print_eckd_dasd_sense_data(SenseDataEckdDasd *sd)
|
|
{
|
|
char msgline[512];
|
|
|
|
if (sd->config_info & 0x8000) {
|
|
sclp_print("Eckd Dasd Sense Data (fmt 24-bytes):\n");
|
|
} else {
|
|
sclp_print("Eckd Dasd Sense Data (fmt 32-bytes):\n");
|
|
}
|
|
|
|
strcat(msgline, " Sense Condition Flags :");
|
|
if (sd->common_status & SNS_STAT0_CMD_REJECT) {
|
|
strcat(msgline, " [Cmd-Reject]");
|
|
}
|
|
if (sd->common_status & SNS_STAT0_INTERVENTION_REQ) {
|
|
strcat(msgline, " [Intervention-Required]");
|
|
}
|
|
if (sd->common_status & SNS_STAT0_BUS_OUT_CHECK) {
|
|
strcat(msgline, " [Bus-Out-Parity-Check]");
|
|
}
|
|
if (sd->common_status & SNS_STAT0_EQUIPMENT_CHECK) {
|
|
strcat(msgline, " [Equipment-Check]");
|
|
}
|
|
if (sd->common_status & SNS_STAT0_DATA_CHECK) {
|
|
strcat(msgline, " [Data-Check]");
|
|
}
|
|
if (sd->common_status & SNS_STAT0_OVERRUN) {
|
|
strcat(msgline, " [Overrun]");
|
|
}
|
|
if (sd->common_status & SNS_STAT0_INCOMPL_DOMAIN) {
|
|
strcat(msgline, " [Incomplete-Domain]");
|
|
}
|
|
|
|
if (sd->status[0] & SNS_STAT1_PERM_ERR) {
|
|
strcat(msgline, " [Permanent-Error]");
|
|
}
|
|
if (sd->status[0] & SNS_STAT1_INV_TRACK_FORMAT) {
|
|
strcat(msgline, " [Invalid-Track-Fmt]");
|
|
}
|
|
if (sd->status[0] & SNS_STAT1_EOC) {
|
|
strcat(msgline, " [End-of-Cyl]");
|
|
}
|
|
if (sd->status[0] & SNS_STAT1_MESSAGE_TO_OPER) {
|
|
strcat(msgline, " [Operator-Msg]");
|
|
}
|
|
if (sd->status[0] & SNS_STAT1_NO_REC_FOUND) {
|
|
strcat(msgline, " [No-Record-Found]");
|
|
}
|
|
if (sd->status[0] & SNS_STAT1_FILE_PROTECTED) {
|
|
strcat(msgline, " [File-Protected]");
|
|
}
|
|
if (sd->status[0] & SNS_STAT1_WRITE_INHIBITED) {
|
|
strcat(msgline, " [Write-Inhibited]");
|
|
}
|
|
if (sd->status[0] & SNS_STAT1_IMPRECISE_END) {
|
|
strcat(msgline, " [Imprecise-Ending]");
|
|
}
|
|
|
|
if (sd->status[1] & SNS_STAT2_REQ_INH_WRITE) {
|
|
strcat(msgline, " [Req-Inhibit-Write]");
|
|
}
|
|
if (sd->status[1] & SNS_STAT2_CORRECTABLE) {
|
|
strcat(msgline, " [Correctable-Data-Check]");
|
|
}
|
|
if (sd->status[1] & SNS_STAT2_FIRST_LOG_ERR) {
|
|
strcat(msgline, " [First-Error-Log]");
|
|
}
|
|
if (sd->status[1] & SNS_STAT2_ENV_DATA_PRESENT) {
|
|
strcat(msgline, " [Env-Data-Present]");
|
|
}
|
|
if (sd->status[1] & SNS_STAT2_IMPRECISE_END) {
|
|
strcat(msgline, " [Imprecise-End]");
|
|
}
|
|
strcat(msgline, "\n");
|
|
sclp_print(msgline);
|
|
|
|
print_int(" Residual Count =", sd->res_count);
|
|
print_int(" Phys Drive ID =", sd->phys_drive_id);
|
|
print_int(" low cyl address =", sd->low_cyl_addr);
|
|
print_int(" head addr & hi cyl =", sd->head_high_cyl_addr);
|
|
print_int(" format/message =", sd->fmt_msg);
|
|
print_int(" fmt-dependent[0-7] =", sd->fmt_dependent_info[0]);
|
|
print_int(" fmt-dependent[8-15]=", sd->fmt_dependent_info[1]);
|
|
print_int(" prog action code =", sd->program_action_code);
|
|
print_int(" Configuration info =", sd->config_info);
|
|
print_int(" mcode / hi-cyl =", sd->mcode_hicyl);
|
|
print_int(" cyl & head addr [0]=", sd->cyl_head_addr[0]);
|
|
print_int(" cyl & head addr [1]=", sd->cyl_head_addr[1]);
|
|
print_int(" cyl & head addr [2]=", sd->cyl_head_addr[2]);
|
|
}
|
|
|
|
static void print_irb_err(Irb *irb)
|
|
{
|
|
uint64_t this_ccw = *(uint64_t *)u32toptr(irb->scsw.cpa);
|
|
uint64_t prev_ccw = *(uint64_t *)u32toptr(irb->scsw.cpa - 8);
|
|
char msgline[256];
|
|
|
|
sclp_print("Interrupt Response Block Data:\n");
|
|
|
|
strcat(msgline, " Function Ctrl :");
|
|
if (irb->scsw.ctrl & SCSW_FCTL_START_FUNC) {
|
|
strcat(msgline, " [Start]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_FCTL_HALT_FUNC) {
|
|
strcat(msgline, " [Halt]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_FCTL_CLEAR_FUNC) {
|
|
strcat(msgline, " [Clear]");
|
|
}
|
|
strcat(msgline, "\n");
|
|
sclp_print(msgline);
|
|
|
|
msgline[0] = '\0';
|
|
strcat(msgline, " Activity Ctrl :");
|
|
if (irb->scsw.ctrl & SCSW_ACTL_RESUME_PEND) {
|
|
strcat(msgline, " [Resume-Pending]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_ACTL_START_PEND) {
|
|
strcat(msgline, " [Start-Pending]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_ACTL_HALT_PEND) {
|
|
strcat(msgline, " [Halt-Pending]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_ACTL_CLEAR_PEND) {
|
|
strcat(msgline, " [Clear-Pending]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_ACTL_CH_ACTIVE) {
|
|
strcat(msgline, " [Channel-Active]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_ACTL_DEV_ACTIVE) {
|
|
strcat(msgline, " [Device-Active]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_ACTL_SUSPENDED) {
|
|
strcat(msgline, " [Suspended]");
|
|
}
|
|
strcat(msgline, "\n");
|
|
sclp_print(msgline);
|
|
|
|
msgline[0] = '\0';
|
|
strcat(msgline, " Status Ctrl :");
|
|
if (irb->scsw.ctrl & SCSW_SCTL_ALERT) {
|
|
strcat(msgline, " [Alert]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_SCTL_INTERMED) {
|
|
strcat(msgline, " [Intermediate]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_SCTL_PRIMARY) {
|
|
strcat(msgline, " [Primary]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_SCTL_SECONDARY) {
|
|
strcat(msgline, " [Secondary]");
|
|
}
|
|
if (irb->scsw.ctrl & SCSW_SCTL_STATUS_PEND) {
|
|
strcat(msgline, " [Status-Pending]");
|
|
}
|
|
|
|
strcat(msgline, "\n");
|
|
sclp_print(msgline);
|
|
|
|
msgline[0] = '\0';
|
|
strcat(msgline, " Device Status :");
|
|
if (irb->scsw.dstat & SCSW_DSTAT_ATTN) {
|
|
strcat(msgline, " [Attention]");
|
|
}
|
|
if (irb->scsw.dstat & SCSW_DSTAT_STATMOD) {
|
|
strcat(msgline, " [Status-Modifier]");
|
|
}
|
|
if (irb->scsw.dstat & SCSW_DSTAT_CUEND) {
|
|
strcat(msgline, " [Ctrl-Unit-End]");
|
|
}
|
|
if (irb->scsw.dstat & SCSW_DSTAT_BUSY) {
|
|
strcat(msgline, " [Busy]");
|
|
}
|
|
if (irb->scsw.dstat & SCSW_DSTAT_CHEND) {
|
|
strcat(msgline, " [Channel-End]");
|
|
}
|
|
if (irb->scsw.dstat & SCSW_DSTAT_DEVEND) {
|
|
strcat(msgline, " [Device-End]");
|
|
}
|
|
if (irb->scsw.dstat & SCSW_DSTAT_UCHK) {
|
|
strcat(msgline, " [Unit-Check]");
|
|
}
|
|
if (irb->scsw.dstat & SCSW_DSTAT_UEXCP) {
|
|
strcat(msgline, " [Unit-Exception]");
|
|
}
|
|
strcat(msgline, "\n");
|
|
sclp_print(msgline);
|
|
|
|
msgline[0] = '\0';
|
|
strcat(msgline, " Channel Status :");
|
|
if (irb->scsw.cstat & SCSW_CSTAT_PCINT) {
|
|
strcat(msgline, " [Program-Ctrl-Interruption]");
|
|
}
|
|
if (irb->scsw.cstat & SCSW_CSTAT_BADLEN) {
|
|
strcat(msgline, " [Incorrect-Length]");
|
|
}
|
|
if (irb->scsw.cstat & SCSW_CSTAT_PROGCHK) {
|
|
strcat(msgline, " [Program-Check]");
|
|
}
|
|
if (irb->scsw.cstat & SCSW_CSTAT_PROTCHK) {
|
|
strcat(msgline, " [Protection-Check]");
|
|
}
|
|
if (irb->scsw.cstat & SCSW_CSTAT_CHDCHK) {
|
|
strcat(msgline, " [Channel-Data-Check]");
|
|
}
|
|
if (irb->scsw.cstat & SCSW_CSTAT_CHCCHK) {
|
|
strcat(msgline, " [Channel-Ctrl-Check]");
|
|
}
|
|
if (irb->scsw.cstat & SCSW_CSTAT_ICCHK) {
|
|
strcat(msgline, " [Interface-Ctrl-Check]");
|
|
}
|
|
if (irb->scsw.cstat & SCSW_CSTAT_CHAINCHK) {
|
|
strcat(msgline, " [Chaining-Check]");
|
|
}
|
|
strcat(msgline, "\n");
|
|
sclp_print(msgline);
|
|
|
|
print_int(" cpa=", irb->scsw.cpa);
|
|
print_int(" prev_ccw=", prev_ccw);
|
|
print_int(" this_ccw=", this_ccw);
|
|
}
|
|
|
|
/*
|
|
* Handles executing ssch, tsch and returns the irb obtained from tsch.
|
|
* Returns 0 on success, -1 if unexpected status pending and we need to retry,
|
|
* otherwise returns condition code from ssch/tsch for error cases.
|
|
*/
|
|
static int __do_cio(SubChannelId schid, uint32_t ccw_addr, int fmt, Irb *irb)
|
|
{
|
|
/*
|
|
* QEMU's CIO implementation requires prefetch and 64-bit idaws. We
|
|
* allow all paths.
|
|
*/
|
|
CmdOrb orb = {
|
|
.fmt = fmt,
|
|
.pfch = 1,
|
|
.c64 = 1,
|
|
.lpm = 0xFF,
|
|
.cpa = ccw_addr,
|
|
};
|
|
int rc;
|
|
|
|
IPL_assert(fmt == 0 || fmt == 1, "Invalid ccw format");
|
|
|
|
/* ccw_addr must be <= 24 bits and point to at least one whole ccw. */
|
|
if (fmt == 0) {
|
|
IPL_assert(ccw_addr <= 0xFFFFFF - 8, "Invalid ccw address");
|
|
}
|
|
|
|
rc = ssch(schid, &orb);
|
|
if (rc == 1 || rc == 2) {
|
|
/* Subchannel status pending or busy. Eat status and ask for retry. */
|
|
tsch(schid, irb);
|
|
return -1;
|
|
}
|
|
if (rc) {
|
|
print_int("ssch failed with cc=", rc);
|
|
return rc;
|
|
}
|
|
|
|
consume_io_int();
|
|
|
|
/* collect status */
|
|
rc = tsch(schid, irb);
|
|
if (rc) {
|
|
print_int("tsch failed with cc=", rc);
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
/*
|
|
* Executes a channel program at a given subchannel. The request to run the
|
|
* channel program is sent to the subchannel, we then wait for the interrupt
|
|
* signaling completion of the I/O operation(s) performed by the channel
|
|
* program. Lastly we verify that the i/o operation completed without error and
|
|
* that the interrupt we received was for the subchannel used to run the
|
|
* channel program.
|
|
*
|
|
* Note: This function assumes it is running in an environment where no other
|
|
* cpus are generating or receiving I/O interrupts. So either run it in a
|
|
* single-cpu environment or make sure all other cpus are not doing I/O and
|
|
* have I/O interrupts masked off. We also assume that only one device is
|
|
* active (generating i/o interrupts).
|
|
*
|
|
* Returns non-zero on error.
|
|
*/
|
|
int do_cio(SubChannelId schid, uint16_t cutype, uint32_t ccw_addr, int fmt)
|
|
{
|
|
Irb irb = {};
|
|
SenseDataEckdDasd sd;
|
|
int rc, retries = 0;
|
|
|
|
while (true) {
|
|
rc = __do_cio(schid, ccw_addr, fmt, &irb);
|
|
|
|
if (rc == -1) {
|
|
retries++;
|
|
continue;
|
|
}
|
|
if (rc) {
|
|
/* ssch/tsch error. Message already reported by __do_cio */
|
|
break;
|
|
}
|
|
|
|
if (!irb_error(&irb)) {
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Unexpected unit check, or interface-control-check. Use sense to
|
|
* clear (unit check only) then retry.
|
|
*/
|
|
if ((unit_check(&irb) || iface_ctrl_check(&irb)) && retries <= 2) {
|
|
if (unit_check(&irb)) {
|
|
basic_sense(schid, cutype, &sd, sizeof(sd));
|
|
}
|
|
retries++;
|
|
continue;
|
|
}
|
|
|
|
sclp_print("cio device error\n");
|
|
print_int(" ssid ", schid.ssid);
|
|
print_int(" cssid ", schid.cssid);
|
|
print_int(" sch_no", schid.sch_no);
|
|
print_int(" ctrl-unit type", cutype);
|
|
sclp_print("\n");
|
|
print_irb_err(&irb);
|
|
if (cutype == CU_TYPE_DASD_3990 || cutype == CU_TYPE_DASD_2107 ||
|
|
cutype == CU_TYPE_UNKNOWN) {
|
|
if (!basic_sense(schid, cutype, &sd, sizeof(sd))) {
|
|
print_eckd_dasd_sense_data(&sd);
|
|
}
|
|
}
|
|
rc = -1;
|
|
break;
|
|
}
|
|
|
|
return rc;
|
|
}
|