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 1192f2ca38SAlexander Graf #include "s390-ccw.h" 1260612d5cSEugene (jno) Dvurechenski #include "virtio.h" 1392f2ca38SAlexander Graf 1492f2ca38SAlexander Graf char stack[PAGE_SIZE * 8] __attribute__((__aligned__(PAGE_SIZE))); 15ff151f4eSDominik Dingel uint64_t boot_value; 16b88d7fa5SEugene (jno) Dvurechenski static SubChannelId blk_schid = { .one = 1 }; 17f2879a5cSChristian Borntraeger 18f2879a5cSChristian Borntraeger /* 19f2879a5cSChristian Borntraeger * Priniciples of Operations (SA22-7832-09) chapter 17 requires that 20f2879a5cSChristian Borntraeger * a subsystem-identification is at 184-187 and bytes 188-191 are zero 21f2879a5cSChristian Borntraeger * after list-directed-IPL and ccw-IPL. 22f2879a5cSChristian Borntraeger */ 23f2879a5cSChristian Borntraeger void write_subsystem_identification(void) 24f2879a5cSChristian Borntraeger { 25b88d7fa5SEugene (jno) Dvurechenski SubChannelId *schid = (SubChannelId *) 184; 26f2879a5cSChristian Borntraeger uint32_t *zeroes = (uint32_t *) 188; 27f2879a5cSChristian Borntraeger 28f2879a5cSChristian Borntraeger *schid = blk_schid; 29f2879a5cSChristian Borntraeger *zeroes = 0; 30f2879a5cSChristian Borntraeger } 31f2879a5cSChristian Borntraeger 3292f2ca38SAlexander Graf 33c9262e8aSEugene (jno) Dvurechenski void panic(const char *string) 3492f2ca38SAlexander Graf { 3592f2ca38SAlexander Graf sclp_print(string); 367f61cbc1SChristian Borntraeger disabled_wait(); 3792f2ca38SAlexander Graf while (1) { } 3892f2ca38SAlexander Graf } 3992f2ca38SAlexander Graf 40b88d7fa5SEugene (jno) Dvurechenski static bool find_dev(Schib *schib, int dev_no) 4192f2ca38SAlexander Graf { 420f79b89bSAlexander Yarygin int i, r; 43ff151f4eSDominik Dingel 4492f2ca38SAlexander Graf for (i = 0; i < 0x10000; i++) { 4592f2ca38SAlexander Graf blk_schid.sch_no = i; 460f79b89bSAlexander Yarygin r = stsch_err(blk_schid, schib); 470f79b89bSAlexander Yarygin if ((r == 3) || (r == -EIO)) { 4822d67ab5SCornelia Huck break; 4922d67ab5SCornelia Huck } 500f79b89bSAlexander Yarygin if (!schib->pmcw.dnv) { 510f79b89bSAlexander Yarygin continue; 5292f2ca38SAlexander Graf } 53a1102cebSEugene (jno) Dvurechenski if (!virtio_is_supported(blk_schid)) { 540f79b89bSAlexander Yarygin continue; 550f79b89bSAlexander Yarygin } 560f79b89bSAlexander Yarygin if ((dev_no < 0) || (schib->pmcw.dev == dev_no)) { 570f79b89bSAlexander Yarygin return true; 580f79b89bSAlexander Yarygin } 590f79b89bSAlexander Yarygin } 600f79b89bSAlexander Yarygin 610f79b89bSAlexander Yarygin return false; 620f79b89bSAlexander Yarygin } 630f79b89bSAlexander Yarygin 640f79b89bSAlexander Yarygin static void virtio_setup(uint64_t dev_info) 650f79b89bSAlexander Yarygin { 66b88d7fa5SEugene (jno) Dvurechenski Schib schib; 670f79b89bSAlexander Yarygin int ssid; 680f79b89bSAlexander Yarygin bool found = false; 690f79b89bSAlexander Yarygin uint16_t dev_no; 700f79b89bSAlexander Yarygin 710f79b89bSAlexander Yarygin /* 720f79b89bSAlexander Yarygin * We unconditionally enable mss support. In every sane configuration, 730f79b89bSAlexander Yarygin * this will succeed; and even if it doesn't, stsch_err() can deal 740f79b89bSAlexander Yarygin * with the consequences. 750f79b89bSAlexander Yarygin */ 760f79b89bSAlexander Yarygin enable_mss_facility(); 770f79b89bSAlexander Yarygin 780f79b89bSAlexander Yarygin if (dev_info != -1) { 790f79b89bSAlexander Yarygin dev_no = dev_info & 0xffff; 800f79b89bSAlexander Yarygin debug_print_int("device no. ", dev_no); 810f79b89bSAlexander Yarygin blk_schid.ssid = (dev_info >> 16) & 0x3; 820f79b89bSAlexander Yarygin debug_print_int("ssid ", blk_schid.ssid); 830f79b89bSAlexander Yarygin found = find_dev(&schib, dev_no); 840f79b89bSAlexander Yarygin } else { 850f79b89bSAlexander Yarygin for (ssid = 0; ssid < 0x3; ssid++) { 860f79b89bSAlexander Yarygin blk_schid.ssid = ssid; 870f79b89bSAlexander Yarygin found = find_dev(&schib, -1); 880f79b89bSAlexander Yarygin if (found) { 890f79b89bSAlexander Yarygin break; 9092f2ca38SAlexander Graf } 9192f2ca38SAlexander Graf } 92ff151f4eSDominik Dingel } 9392f2ca38SAlexander Graf 94*80ba3e24SEugene (jno) Dvurechenski IPL_assert(found, "No virtio device found"); 9592f2ca38SAlexander Graf 96a1102cebSEugene (jno) Dvurechenski virtio_setup_device(blk_schid); 9760612d5cSEugene (jno) Dvurechenski 98*80ba3e24SEugene (jno) Dvurechenski IPL_assert(virtio_ipl_disk_is_valid(), "No valid IPL device detected"); 9992f2ca38SAlexander Graf } 10092f2ca38SAlexander Graf 10192f2ca38SAlexander Graf int main(void) 10292f2ca38SAlexander Graf { 10392f2ca38SAlexander Graf sclp_setup(); 104ff151f4eSDominik Dingel debug_print_int("boot reg[7] ", boot_value); 105ff151f4eSDominik Dingel virtio_setup(boot_value); 106ff151f4eSDominik Dingel 10760612d5cSEugene (jno) Dvurechenski zipl_load(); /* no return */ 10860612d5cSEugene (jno) Dvurechenski 109c9262e8aSEugene (jno) Dvurechenski panic("Failed to load OS from hard disk\n"); 11060612d5cSEugene (jno) Dvurechenski return 0; /* make compiler happy */ 11192f2ca38SAlexander Graf } 112