192f2ca38SAlexander Graf /* 292f2ca38SAlexander Graf * S390 virtio-ccw loading program 392f2ca38SAlexander Graf * 492f2ca38SAlexander Graf * Copyright (c) 2013 Alexander Graf <agraf@suse.de> 592f2ca38SAlexander Graf * 692f2ca38SAlexander Graf * This work is licensed under the terms of the GNU GPL, version 2 or (at 792f2ca38SAlexander Graf * your option) any later version. See the COPYING file in the top-level 892f2ca38SAlexander Graf * directory. 992f2ca38SAlexander Graf */ 1092f2ca38SAlexander Graf 11*90806fecSThomas Huth #include "libc.h" 1292f2ca38SAlexander Graf #include "s390-ccw.h" 1360612d5cSEugene (jno) Dvurechenski #include "virtio.h" 1492f2ca38SAlexander Graf 1592f2ca38SAlexander Graf char stack[PAGE_SIZE * 8] __attribute__((__aligned__(PAGE_SIZE))); 16b88d7fa5SEugene (jno) Dvurechenski static SubChannelId blk_schid = { .one = 1 }; 17d046c51dSAlexander Yarygin IplParameterBlock iplb __attribute__((__aligned__(PAGE_SIZE))); 1895fa1af8SFarhan Ali static char loadparm[8] = { 0, 0, 0, 0, 0, 0, 0, 0 }; 19f2879a5cSChristian Borntraeger 20cfe2124aSEugene (jno) Dvurechenski const unsigned char ebc2asc[256] = 21cfe2124aSEugene (jno) Dvurechenski /* 0123456789abcdef0123456789abcdef */ 22cfe2124aSEugene (jno) Dvurechenski "................................" /* 1F */ 23cfe2124aSEugene (jno) Dvurechenski "................................" /* 3F */ 24cfe2124aSEugene (jno) Dvurechenski " ...........<(+|&.........!$*);." /* 5F first.chr.here.is.real.space */ 25cfe2124aSEugene (jno) Dvurechenski "-/.........,%_>?.........`:#@'=\""/* 7F */ 26cfe2124aSEugene (jno) Dvurechenski ".abcdefghi.......jklmnopqr......" /* 9F */ 27cfe2124aSEugene (jno) Dvurechenski "..stuvwxyz......................" /* BF */ 28cfe2124aSEugene (jno) Dvurechenski ".ABCDEFGHI.......JKLMNOPQR......" /* DF */ 29cfe2124aSEugene (jno) Dvurechenski "..STUVWXYZ......0123456789......";/* FF */ 30cfe2124aSEugene (jno) Dvurechenski 31f2879a5cSChristian Borntraeger /* 32f2879a5cSChristian Borntraeger * Priniciples of Operations (SA22-7832-09) chapter 17 requires that 33f2879a5cSChristian Borntraeger * a subsystem-identification is at 184-187 and bytes 188-191 are zero 34f2879a5cSChristian Borntraeger * after list-directed-IPL and ccw-IPL. 35f2879a5cSChristian Borntraeger */ 36f2879a5cSChristian Borntraeger void write_subsystem_identification(void) 37f2879a5cSChristian Borntraeger { 38b88d7fa5SEugene (jno) Dvurechenski SubChannelId *schid = (SubChannelId *) 184; 39f2879a5cSChristian Borntraeger uint32_t *zeroes = (uint32_t *) 188; 40f2879a5cSChristian Borntraeger 41f2879a5cSChristian Borntraeger *schid = blk_schid; 42f2879a5cSChristian Borntraeger *zeroes = 0; 43f2879a5cSChristian Borntraeger } 44f2879a5cSChristian Borntraeger 45c9262e8aSEugene (jno) Dvurechenski void panic(const char *string) 4692f2ca38SAlexander Graf { 4792f2ca38SAlexander Graf sclp_print(string); 487f61cbc1SChristian Borntraeger disabled_wait(); 4992f2ca38SAlexander Graf while (1) { } 5092f2ca38SAlexander Graf } 5192f2ca38SAlexander Graf 5295fa1af8SFarhan Ali unsigned int get_loadparm_index(void) 5395fa1af8SFarhan Ali { 5495fa1af8SFarhan Ali const char *lp = loadparm; 5595fa1af8SFarhan Ali int i; 5695fa1af8SFarhan Ali unsigned int idx = 0; 5795fa1af8SFarhan Ali 5895fa1af8SFarhan Ali for (i = 0; i < 8; i++) { 5995fa1af8SFarhan Ali char c = lp[i]; 6095fa1af8SFarhan Ali 6195fa1af8SFarhan Ali if (c < '0' || c > '9') { 6295fa1af8SFarhan Ali break; 6395fa1af8SFarhan Ali } 6495fa1af8SFarhan Ali 6595fa1af8SFarhan Ali idx *= 10; 6695fa1af8SFarhan Ali idx += c - '0'; 6795fa1af8SFarhan Ali } 6895fa1af8SFarhan Ali 6995fa1af8SFarhan Ali return idx; 7095fa1af8SFarhan Ali } 7195fa1af8SFarhan Ali 72b88d7fa5SEugene (jno) Dvurechenski static bool find_dev(Schib *schib, int dev_no) 7392f2ca38SAlexander Graf { 740f79b89bSAlexander Yarygin int i, r; 75ff151f4eSDominik Dingel 7692f2ca38SAlexander Graf for (i = 0; i < 0x10000; i++) { 7792f2ca38SAlexander Graf blk_schid.sch_no = i; 780f79b89bSAlexander Yarygin r = stsch_err(blk_schid, schib); 790f79b89bSAlexander Yarygin if ((r == 3) || (r == -EIO)) { 8022d67ab5SCornelia Huck break; 8122d67ab5SCornelia Huck } 820f79b89bSAlexander Yarygin if (!schib->pmcw.dnv) { 830f79b89bSAlexander Yarygin continue; 8492f2ca38SAlexander Graf } 85a1102cebSEugene (jno) Dvurechenski if (!virtio_is_supported(blk_schid)) { 860f79b89bSAlexander Yarygin continue; 870f79b89bSAlexander Yarygin } 8899b72e0fSFarhan Ali /* Skip net devices since no IPLB is created and therefore no 8999b72e0fSFarhan Ali * no network bootloader has been loaded 9099b72e0fSFarhan Ali */ 9199b72e0fSFarhan Ali if (virtio_get_device_type() == VIRTIO_ID_NET && dev_no < 0) { 9299b72e0fSFarhan Ali continue; 9399b72e0fSFarhan Ali } 940f79b89bSAlexander Yarygin if ((dev_no < 0) || (schib->pmcw.dev == dev_no)) { 950f79b89bSAlexander Yarygin return true; 960f79b89bSAlexander Yarygin } 970f79b89bSAlexander Yarygin } 980f79b89bSAlexander Yarygin 990f79b89bSAlexander Yarygin return false; 1000f79b89bSAlexander Yarygin } 1010f79b89bSAlexander Yarygin 102d046c51dSAlexander Yarygin static void virtio_setup(void) 1030f79b89bSAlexander Yarygin { 104b88d7fa5SEugene (jno) Dvurechenski Schib schib; 1050f79b89bSAlexander Yarygin int ssid; 1060f79b89bSAlexander Yarygin bool found = false; 1070f79b89bSAlexander Yarygin uint16_t dev_no; 10895fa1af8SFarhan Ali char ldp[] = "LOADPARM=[________]\n"; 10999b72e0fSFarhan Ali VDev *vdev = virtio_get_device(); 1100f79b89bSAlexander Yarygin 1110f79b89bSAlexander Yarygin /* 1120f79b89bSAlexander Yarygin * We unconditionally enable mss support. In every sane configuration, 1130f79b89bSAlexander Yarygin * this will succeed; and even if it doesn't, stsch_err() can deal 1140f79b89bSAlexander Yarygin * with the consequences. 1150f79b89bSAlexander Yarygin */ 1160f79b89bSAlexander Yarygin enable_mss_facility(); 1170f79b89bSAlexander Yarygin 11895fa1af8SFarhan Ali sclp_get_loadparm_ascii(loadparm); 11995fa1af8SFarhan Ali memcpy(ldp + 10, loadparm, 8); 12095fa1af8SFarhan Ali sclp_print(ldp); 12195fa1af8SFarhan Ali 122d046c51dSAlexander Yarygin if (store_iplb(&iplb)) { 123d046c51dSAlexander Yarygin switch (iplb.pbt) { 124d046c51dSAlexander Yarygin case S390_IPL_TYPE_CCW: 125d046c51dSAlexander Yarygin dev_no = iplb.ccw.devno; 1260f79b89bSAlexander Yarygin debug_print_int("device no. ", dev_no); 127d046c51dSAlexander Yarygin blk_schid.ssid = iplb.ccw.ssid & 0x3; 1280f79b89bSAlexander Yarygin debug_print_int("ssid ", blk_schid.ssid); 1290f79b89bSAlexander Yarygin found = find_dev(&schib, dev_no); 130d046c51dSAlexander Yarygin break; 131b39b7718SEugene (jno) Dvurechenski case S390_IPL_TYPE_QEMU_SCSI: 132b39b7718SEugene (jno) Dvurechenski vdev->scsi_device_selected = true; 133b39b7718SEugene (jno) Dvurechenski vdev->selected_scsi_device.channel = iplb.scsi.channel; 134b39b7718SEugene (jno) Dvurechenski vdev->selected_scsi_device.target = iplb.scsi.target; 135b39b7718SEugene (jno) Dvurechenski vdev->selected_scsi_device.lun = iplb.scsi.lun; 136b39b7718SEugene (jno) Dvurechenski blk_schid.ssid = iplb.scsi.ssid & 0x3; 137b39b7718SEugene (jno) Dvurechenski found = find_dev(&schib, iplb.scsi.devno); 138b39b7718SEugene (jno) Dvurechenski break; 139d046c51dSAlexander Yarygin default: 140d046c51dSAlexander Yarygin panic("List-directed IPL not supported yet!\n"); 141d046c51dSAlexander Yarygin } 1420f79b89bSAlexander Yarygin } else { 1430f79b89bSAlexander Yarygin for (ssid = 0; ssid < 0x3; ssid++) { 1440f79b89bSAlexander Yarygin blk_schid.ssid = ssid; 1450f79b89bSAlexander Yarygin found = find_dev(&schib, -1); 1460f79b89bSAlexander Yarygin if (found) { 1470f79b89bSAlexander Yarygin break; 14892f2ca38SAlexander Graf } 14992f2ca38SAlexander Graf } 150ff151f4eSDominik Dingel } 15192f2ca38SAlexander Graf 15280ba3e24SEugene (jno) Dvurechenski IPL_assert(found, "No virtio device found"); 15392f2ca38SAlexander Graf 15499b72e0fSFarhan Ali if (virtio_get_device_type() == VIRTIO_ID_NET) { 15599b72e0fSFarhan Ali sclp_print("Network boot device detected\n"); 15699b72e0fSFarhan Ali vdev->netboot_start_addr = iplb.ccw.netboot_start_addr; 15799b72e0fSFarhan Ali } else { 158a1102cebSEugene (jno) Dvurechenski virtio_setup_device(blk_schid); 15960612d5cSEugene (jno) Dvurechenski 16080ba3e24SEugene (jno) Dvurechenski IPL_assert(virtio_ipl_disk_is_valid(), "No valid IPL device detected"); 16192f2ca38SAlexander Graf } 16299b72e0fSFarhan Ali } 16392f2ca38SAlexander Graf 16492f2ca38SAlexander Graf int main(void) 16592f2ca38SAlexander Graf { 16692f2ca38SAlexander Graf sclp_setup(); 167d046c51dSAlexander Yarygin virtio_setup(); 168ff151f4eSDominik Dingel 16960612d5cSEugene (jno) Dvurechenski zipl_load(); /* no return */ 17060612d5cSEugene (jno) Dvurechenski 171c9262e8aSEugene (jno) Dvurechenski panic("Failed to load OS from hard disk\n"); 17260612d5cSEugene (jno) Dvurechenski return 0; /* make compiler happy */ 17392f2ca38SAlexander Graf } 174