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 1190806fecSThomas 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 }; 19118ee80fSCollin L. Walling QemuIplParameters qipl; 20f2879a5cSChristian Borntraeger 21*9eaa654aSCollin L. Walling #define LOADPARM_PROMPT "PROMPT " 22*9eaa654aSCollin L. Walling #define LOADPARM_EMPTY "........" 23*9eaa654aSCollin L. Walling 24f2879a5cSChristian Borntraeger /* 25f2879a5cSChristian Borntraeger * Priniciples of Operations (SA22-7832-09) chapter 17 requires that 26f2879a5cSChristian Borntraeger * a subsystem-identification is at 184-187 and bytes 188-191 are zero 27f2879a5cSChristian Borntraeger * after list-directed-IPL and ccw-IPL. 28f2879a5cSChristian Borntraeger */ 29f2879a5cSChristian Borntraeger void write_subsystem_identification(void) 30f2879a5cSChristian Borntraeger { 31b88d7fa5SEugene (jno) Dvurechenski SubChannelId *schid = (SubChannelId *) 184; 32f2879a5cSChristian Borntraeger uint32_t *zeroes = (uint32_t *) 188; 33f2879a5cSChristian Borntraeger 34f2879a5cSChristian Borntraeger *schid = blk_schid; 35f2879a5cSChristian Borntraeger *zeroes = 0; 36f2879a5cSChristian Borntraeger } 37f2879a5cSChristian Borntraeger 38c9262e8aSEugene (jno) Dvurechenski void panic(const char *string) 3992f2ca38SAlexander Graf { 4092f2ca38SAlexander Graf sclp_print(string); 417f61cbc1SChristian Borntraeger disabled_wait(); 4292f2ca38SAlexander Graf while (1) { } 4392f2ca38SAlexander Graf } 4492f2ca38SAlexander Graf 4595fa1af8SFarhan Ali unsigned int get_loadparm_index(void) 4695fa1af8SFarhan Ali { 47fc0e2087SCollin L. Walling return atoui(loadparm); 4895fa1af8SFarhan Ali } 4995fa1af8SFarhan Ali 50b88d7fa5SEugene (jno) Dvurechenski static bool find_dev(Schib *schib, int dev_no) 5192f2ca38SAlexander Graf { 520f79b89bSAlexander Yarygin int i, r; 53ff151f4eSDominik Dingel 5492f2ca38SAlexander Graf for (i = 0; i < 0x10000; i++) { 5592f2ca38SAlexander Graf blk_schid.sch_no = i; 560f79b89bSAlexander Yarygin r = stsch_err(blk_schid, schib); 570f79b89bSAlexander Yarygin if ((r == 3) || (r == -EIO)) { 5822d67ab5SCornelia Huck break; 5922d67ab5SCornelia Huck } 600f79b89bSAlexander Yarygin if (!schib->pmcw.dnv) { 610f79b89bSAlexander Yarygin continue; 6292f2ca38SAlexander Graf } 63a1102cebSEugene (jno) Dvurechenski if (!virtio_is_supported(blk_schid)) { 640f79b89bSAlexander Yarygin continue; 650f79b89bSAlexander Yarygin } 6699b72e0fSFarhan Ali /* Skip net devices since no IPLB is created and therefore no 6799b72e0fSFarhan Ali * no network bootloader has been loaded 6899b72e0fSFarhan Ali */ 6999b72e0fSFarhan Ali if (virtio_get_device_type() == VIRTIO_ID_NET && dev_no < 0) { 7099b72e0fSFarhan Ali continue; 7199b72e0fSFarhan Ali } 720f79b89bSAlexander Yarygin if ((dev_no < 0) || (schib->pmcw.dev == dev_no)) { 730f79b89bSAlexander Yarygin return true; 740f79b89bSAlexander Yarygin } 750f79b89bSAlexander Yarygin } 760f79b89bSAlexander Yarygin 770f79b89bSAlexander Yarygin return false; 780f79b89bSAlexander Yarygin } 790f79b89bSAlexander Yarygin 80*9eaa654aSCollin L. Walling static void menu_setup(void) 81*9eaa654aSCollin L. Walling { 82*9eaa654aSCollin L. Walling if (memcmp(loadparm, LOADPARM_PROMPT, 8) == 0) { 83*9eaa654aSCollin L. Walling menu_set_parms(QIPL_FLAG_BM_OPTS_CMD, 0); 84*9eaa654aSCollin L. Walling return; 85*9eaa654aSCollin L. Walling } 86*9eaa654aSCollin L. Walling 87*9eaa654aSCollin L. Walling /* If loadparm was set to any other value, then do not enable menu */ 88*9eaa654aSCollin L. Walling if (memcmp(loadparm, LOADPARM_EMPTY, 8) != 0) { 89*9eaa654aSCollin L. Walling return; 90*9eaa654aSCollin L. Walling } 91*9eaa654aSCollin L. Walling 92*9eaa654aSCollin L. Walling switch (iplb.pbt) { 93*9eaa654aSCollin L. Walling case S390_IPL_TYPE_CCW: 94*9eaa654aSCollin L. Walling menu_set_parms(qipl.qipl_flags & QIPL_FLAG_BM_OPTS_CMD, 95*9eaa654aSCollin L. Walling qipl.boot_menu_timeout); 96*9eaa654aSCollin L. Walling return; 97*9eaa654aSCollin L. Walling } 98*9eaa654aSCollin L. Walling } 99*9eaa654aSCollin L. Walling 100d046c51dSAlexander Yarygin static void virtio_setup(void) 1010f79b89bSAlexander Yarygin { 102b88d7fa5SEugene (jno) Dvurechenski Schib schib; 1030f79b89bSAlexander Yarygin int ssid; 1040f79b89bSAlexander Yarygin bool found = false; 1050f79b89bSAlexander Yarygin uint16_t dev_no; 10695fa1af8SFarhan Ali char ldp[] = "LOADPARM=[________]\n"; 10799b72e0fSFarhan Ali VDev *vdev = virtio_get_device(); 108118ee80fSCollin L. Walling QemuIplParameters *early_qipl = (QemuIplParameters *)QIPL_ADDRESS; 1090f79b89bSAlexander Yarygin 1100f79b89bSAlexander Yarygin /* 1110f79b89bSAlexander Yarygin * We unconditionally enable mss support. In every sane configuration, 1120f79b89bSAlexander Yarygin * this will succeed; and even if it doesn't, stsch_err() can deal 1130f79b89bSAlexander Yarygin * with the consequences. 1140f79b89bSAlexander Yarygin */ 1150f79b89bSAlexander Yarygin enable_mss_facility(); 1160f79b89bSAlexander Yarygin 11795fa1af8SFarhan Ali sclp_get_loadparm_ascii(loadparm); 11895fa1af8SFarhan Ali memcpy(ldp + 10, loadparm, 8); 11995fa1af8SFarhan Ali sclp_print(ldp); 12095fa1af8SFarhan Ali 121118ee80fSCollin L. Walling memcpy(&qipl, early_qipl, sizeof(QemuIplParameters)); 122118ee80fSCollin L. Walling 123d046c51dSAlexander Yarygin if (store_iplb(&iplb)) { 124d046c51dSAlexander Yarygin switch (iplb.pbt) { 125d046c51dSAlexander Yarygin case S390_IPL_TYPE_CCW: 126d046c51dSAlexander Yarygin dev_no = iplb.ccw.devno; 1270f79b89bSAlexander Yarygin debug_print_int("device no. ", dev_no); 128d046c51dSAlexander Yarygin blk_schid.ssid = iplb.ccw.ssid & 0x3; 1290f79b89bSAlexander Yarygin debug_print_int("ssid ", blk_schid.ssid); 1300f79b89bSAlexander Yarygin found = find_dev(&schib, dev_no); 131d046c51dSAlexander Yarygin break; 132b39b7718SEugene (jno) Dvurechenski case S390_IPL_TYPE_QEMU_SCSI: 133b39b7718SEugene (jno) Dvurechenski vdev->scsi_device_selected = true; 134b39b7718SEugene (jno) Dvurechenski vdev->selected_scsi_device.channel = iplb.scsi.channel; 135b39b7718SEugene (jno) Dvurechenski vdev->selected_scsi_device.target = iplb.scsi.target; 136b39b7718SEugene (jno) Dvurechenski vdev->selected_scsi_device.lun = iplb.scsi.lun; 137b39b7718SEugene (jno) Dvurechenski blk_schid.ssid = iplb.scsi.ssid & 0x3; 138b39b7718SEugene (jno) Dvurechenski found = find_dev(&schib, iplb.scsi.devno); 139b39b7718SEugene (jno) Dvurechenski break; 140d046c51dSAlexander Yarygin default: 141d046c51dSAlexander Yarygin panic("List-directed IPL not supported yet!\n"); 142d046c51dSAlexander Yarygin } 143*9eaa654aSCollin L. Walling menu_setup(); 1440f79b89bSAlexander Yarygin } else { 1450f79b89bSAlexander Yarygin for (ssid = 0; ssid < 0x3; ssid++) { 1460f79b89bSAlexander Yarygin blk_schid.ssid = ssid; 1470f79b89bSAlexander Yarygin found = find_dev(&schib, -1); 1480f79b89bSAlexander Yarygin if (found) { 1490f79b89bSAlexander Yarygin break; 15092f2ca38SAlexander Graf } 15192f2ca38SAlexander Graf } 152ff151f4eSDominik Dingel } 15392f2ca38SAlexander Graf 15480ba3e24SEugene (jno) Dvurechenski IPL_assert(found, "No virtio device found"); 15592f2ca38SAlexander Graf 15699b72e0fSFarhan Ali if (virtio_get_device_type() == VIRTIO_ID_NET) { 15799b72e0fSFarhan Ali sclp_print("Network boot device detected\n"); 158118ee80fSCollin L. Walling vdev->netboot_start_addr = qipl.netboot_start_addr; 15999b72e0fSFarhan Ali } else { 160867e039aSThomas Huth virtio_blk_setup_device(blk_schid); 16160612d5cSEugene (jno) Dvurechenski 16280ba3e24SEugene (jno) Dvurechenski IPL_assert(virtio_ipl_disk_is_valid(), "No valid IPL device detected"); 16392f2ca38SAlexander Graf } 16499b72e0fSFarhan Ali } 16592f2ca38SAlexander Graf 16692f2ca38SAlexander Graf int main(void) 16792f2ca38SAlexander Graf { 16892f2ca38SAlexander Graf sclp_setup(); 169d046c51dSAlexander Yarygin virtio_setup(); 170ff151f4eSDominik Dingel 17160612d5cSEugene (jno) Dvurechenski zipl_load(); /* no return */ 17260612d5cSEugene (jno) Dvurechenski 173c9262e8aSEugene (jno) Dvurechenski panic("Failed to load OS from hard disk\n"); 17460612d5cSEugene (jno) Dvurechenski return 0; /* make compiler happy */ 17592f2ca38SAlexander Graf } 176