13e4415a7SThomas Huth /* 23e4415a7SThomas Huth * S390 virtio-ccw network boot loading program 33e4415a7SThomas Huth * 43e4415a7SThomas Huth * Copyright 2017 Thomas Huth, Red Hat Inc. 53e4415a7SThomas Huth * 63e4415a7SThomas Huth * Based on the S390 virtio-ccw loading program (main.c) 73e4415a7SThomas Huth * Copyright (c) 2013 Alexander Graf <agraf@suse.de> 83e4415a7SThomas Huth * 929d12216SThomas Huth * And based on the network loading code from SLOF (netload.c) 1029d12216SThomas Huth * Copyright (c) 2004, 2008 IBM Corporation 1129d12216SThomas Huth * 123e4415a7SThomas Huth * This code is free software; you can redistribute it and/or modify it 133e4415a7SThomas Huth * under the terms of the GNU General Public License as published by the 143e4415a7SThomas Huth * Free Software Foundation; either version 2 of the License, or (at your 153e4415a7SThomas Huth * option) any later version. 163e4415a7SThomas Huth */ 173e4415a7SThomas Huth 183e4415a7SThomas Huth #include <stdint.h> 193e4415a7SThomas Huth #include <stdbool.h> 203e4415a7SThomas Huth #include <stdio.h> 213e4415a7SThomas Huth #include <stdlib.h> 223e4415a7SThomas Huth #include <string.h> 233e4415a7SThomas Huth #include <unistd.h> 2429d12216SThomas Huth 2529d12216SThomas Huth #include <tftp.h> 2629d12216SThomas Huth #include <ethernet.h> 2729d12216SThomas Huth #include <dhcp.h> 2829d12216SThomas Huth #include <dhcpv6.h> 2929d12216SThomas Huth #include <ipv4.h> 3029d12216SThomas Huth #include <ipv6.h> 3129d12216SThomas Huth #include <dns.h> 323e4415a7SThomas Huth #include <time.h> 33ec623990SThomas Huth #include <pxelinux.h> 343e4415a7SThomas Huth 353e4415a7SThomas Huth #include "s390-ccw.h" 363e4415a7SThomas Huth #include "virtio.h" 373e4415a7SThomas Huth 3829d12216SThomas Huth #define DEFAULT_BOOT_RETRIES 10 3929d12216SThomas Huth #define DEFAULT_TFTP_RETRIES 20 4029d12216SThomas Huth 413e4415a7SThomas Huth extern char _start[]; 423e4415a7SThomas Huth 43c4942ee9SThomas Huth #define KERNEL_ADDR ((void *)0L) 44c4942ee9SThomas Huth #define KERNEL_MAX_SIZE ((long)_start) 45ec623990SThomas Huth #define ARCH_COMMAND_LINE_SIZE 896 /* Taken from Linux kernel */ 46c4942ee9SThomas Huth 47*0d8261b5SThomas Huth /* STSI 3.2.2 offset of first vmdb + offset of uuid inside vmdb */ 48*0d8261b5SThomas Huth #define STSI322_VMDB_UUID_OFFSET ((8 + 12) * 4) 49*0d8261b5SThomas Huth 503e4415a7SThomas Huth char stack[PAGE_SIZE * 8] __attribute__((aligned(PAGE_SIZE))); 513e4415a7SThomas Huth IplParameterBlock iplb __attribute__((aligned(PAGE_SIZE))); 52c4942ee9SThomas Huth static char cfgbuf[2048]; 533e4415a7SThomas Huth 543e4415a7SThomas Huth static SubChannelId net_schid = { .one = 1 }; 55ec623990SThomas Huth static uint8_t mac[6]; 563e4415a7SThomas Huth static uint64_t dest_timer; 573e4415a7SThomas Huth 583e4415a7SThomas Huth static uint64_t get_timer_ms(void) 593e4415a7SThomas Huth { 603e4415a7SThomas Huth uint64_t clk; 613e4415a7SThomas Huth 623e4415a7SThomas Huth asm volatile(" stck %0 " : : "Q"(clk) : "memory"); 633e4415a7SThomas Huth 643e4415a7SThomas Huth /* Bit 51 is incremented each microsecond */ 653e4415a7SThomas Huth return (clk >> (63 - 51)) / 1000; 663e4415a7SThomas Huth } 673e4415a7SThomas Huth 683e4415a7SThomas Huth void set_timer(int val) 693e4415a7SThomas Huth { 703e4415a7SThomas Huth dest_timer = get_timer_ms() + val; 713e4415a7SThomas Huth } 723e4415a7SThomas Huth 733e4415a7SThomas Huth int get_timer(void) 743e4415a7SThomas Huth { 753e4415a7SThomas Huth return dest_timer - get_timer_ms(); 763e4415a7SThomas Huth } 773e4415a7SThomas Huth 783e4415a7SThomas Huth int get_sec_ticks(void) 793e4415a7SThomas Huth { 803e4415a7SThomas Huth return 1000; /* number of ticks in 1 second */ 813e4415a7SThomas Huth } 823e4415a7SThomas Huth 8329d12216SThomas Huth /** 8429d12216SThomas Huth * Obtain IP and configuration info from DHCP server (either IPv4 or IPv6). 8529d12216SThomas Huth * @param fn_ip contains the following configuration information: 8629d12216SThomas Huth * client MAC, client IP, TFTP-server MAC, TFTP-server IP, 8729d12216SThomas Huth * boot file name 8829d12216SThomas Huth * @param retries Number of DHCP attempts 8929d12216SThomas Huth * @return 0 : IP and configuration info obtained; 9029d12216SThomas Huth * non-0 : error condition occurred. 9129d12216SThomas Huth */ 9229d12216SThomas Huth static int dhcp(struct filename_ip *fn_ip, int retries) 9329d12216SThomas Huth { 9429d12216SThomas Huth int i = retries + 1; 9529d12216SThomas Huth int rc = -1; 9629d12216SThomas Huth 9729d12216SThomas Huth printf(" Requesting information via DHCP: "); 9829d12216SThomas Huth 9929d12216SThomas Huth dhcpv4_generate_transaction_id(); 10029d12216SThomas Huth dhcpv6_generate_transaction_id(); 10129d12216SThomas Huth 10229d12216SThomas Huth do { 10329d12216SThomas Huth printf("\b\b\b%03d", i - 1); 10429d12216SThomas Huth if (!--i) { 10529d12216SThomas Huth printf("\nGiving up after %d DHCP requests\n", retries); 10629d12216SThomas Huth return -1; 10729d12216SThomas Huth } 108134f0b3dSThomas Huth fn_ip->ip_version = 4; 10929d12216SThomas Huth rc = dhcpv4(NULL, fn_ip); 11029d12216SThomas Huth if (rc == -1) { 111134f0b3dSThomas Huth fn_ip->ip_version = 6; 11229d12216SThomas Huth set_ipv6_address(fn_ip->fd, 0); 11329d12216SThomas Huth rc = dhcpv6(NULL, fn_ip); 11429d12216SThomas Huth if (rc == 0) { 11529d12216SThomas Huth memcpy(&fn_ip->own_ip6, get_ipv6_address(), 16); 11629d12216SThomas Huth break; 11729d12216SThomas Huth } 11829d12216SThomas Huth } 11929d12216SThomas Huth if (rc != -1) { /* either success or non-dhcp failure */ 12029d12216SThomas Huth break; 12129d12216SThomas Huth } 12229d12216SThomas Huth } while (1); 12329d12216SThomas Huth printf("\b\b\b\bdone\n"); 12429d12216SThomas Huth 12529d12216SThomas Huth return rc; 12629d12216SThomas Huth } 12729d12216SThomas Huth 12829d12216SThomas Huth /** 12929d12216SThomas Huth * Seed the random number generator with our mac and current timestamp 13029d12216SThomas Huth */ 13129d12216SThomas Huth static void seed_rng(uint8_t mac[]) 13229d12216SThomas Huth { 13329d12216SThomas Huth uint64_t seed; 13429d12216SThomas Huth 13529d12216SThomas Huth asm volatile(" stck %0 " : : "Q"(seed) : "memory"); 13629d12216SThomas Huth seed ^= (mac[2] << 24) | (mac[3] << 16) | (mac[4] << 8) | mac[5]; 13729d12216SThomas Huth srand(seed); 13829d12216SThomas Huth } 13929d12216SThomas Huth 1400c188229SThomas Huth static int tftp_load(filename_ip_t *fnip, void *buffer, int len) 14129d12216SThomas Huth { 14229d12216SThomas Huth tftp_err_t tftp_err; 14329d12216SThomas Huth int rc; 14429d12216SThomas Huth 145134f0b3dSThomas Huth rc = tftp(fnip, buffer, len, DEFAULT_TFTP_RETRIES, &tftp_err); 14629d12216SThomas Huth 147c4942ee9SThomas Huth if (rc < 0) { 148c4942ee9SThomas Huth /* Make sure that error messages are put into a new line */ 149c4942ee9SThomas Huth printf("\n "); 150c4942ee9SThomas Huth } 151c4942ee9SThomas Huth 152c4942ee9SThomas Huth if (rc > 1024) { 153c4942ee9SThomas Huth printf(" TFTP: Received %s (%d KBytes)\n", fnip->filename, rc / 1024); 154c4942ee9SThomas Huth } else if (rc > 0) { 155c4942ee9SThomas Huth printf(" TFTP: Received %s (%d Bytes)\n", fnip->filename, rc); 156134f0b3dSThomas Huth } else { 157134f0b3dSThomas Huth const char *errstr = NULL; 158134f0b3dSThomas Huth int ecode; 159134f0b3dSThomas Huth tftp_get_error_info(fnip, &tftp_err, rc, &errstr, &ecode); 160134f0b3dSThomas Huth printf("TFTP error: %s\n", errstr ? errstr : "unknown error"); 16129d12216SThomas Huth } 16229d12216SThomas Huth 16329d12216SThomas Huth return rc; 16429d12216SThomas Huth } 16529d12216SThomas Huth 1660c188229SThomas Huth static int net_init(filename_ip_t *fn_ip) 16729d12216SThomas Huth { 16829d12216SThomas Huth int rc; 16929d12216SThomas Huth 1700c188229SThomas Huth memset(fn_ip, 0, sizeof(filename_ip_t)); 17129d12216SThomas Huth 17229d12216SThomas Huth rc = virtio_net_init(mac); 17329d12216SThomas Huth if (rc < 0) { 17429d12216SThomas Huth puts("Could not initialize network device"); 17529d12216SThomas Huth return -101; 17629d12216SThomas Huth } 1770c188229SThomas Huth fn_ip->fd = rc; 17829d12216SThomas Huth 17929d12216SThomas Huth printf(" Using MAC address: %02x:%02x:%02x:%02x:%02x:%02x\n", 18029d12216SThomas Huth mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]); 18129d12216SThomas Huth 18229d12216SThomas Huth set_mac_address(mac); /* init ethernet layer */ 18329d12216SThomas Huth seed_rng(mac); 18429d12216SThomas Huth 1850c188229SThomas Huth rc = dhcp(fn_ip, DEFAULT_BOOT_RETRIES); 18629d12216SThomas Huth if (rc >= 0) { 187134f0b3dSThomas Huth if (fn_ip->ip_version == 4) { 1880c188229SThomas Huth set_ipv4_address(fn_ip->own_ip); 18929d12216SThomas Huth } 19029d12216SThomas Huth } else { 19129d12216SThomas Huth puts("Could not get IP address"); 19229d12216SThomas Huth return -101; 19329d12216SThomas Huth } 19429d12216SThomas Huth 195134f0b3dSThomas Huth if (fn_ip->ip_version == 4) { 19629d12216SThomas Huth printf(" Using IPv4 address: %d.%d.%d.%d\n", 1970c188229SThomas Huth (fn_ip->own_ip >> 24) & 0xFF, (fn_ip->own_ip >> 16) & 0xFF, 1980c188229SThomas Huth (fn_ip->own_ip >> 8) & 0xFF, fn_ip->own_ip & 0xFF); 199134f0b3dSThomas Huth } else if (fn_ip->ip_version == 6) { 20029d12216SThomas Huth char ip6_str[40]; 2010c188229SThomas Huth ipv6_to_str(fn_ip->own_ip6.addr, ip6_str); 20229d12216SThomas Huth printf(" Using IPv6 address: %s\n", ip6_str); 20329d12216SThomas Huth } 20429d12216SThomas Huth 20529d12216SThomas Huth if (rc == -2) { 20629d12216SThomas Huth printf("ARP request to TFTP server (%d.%d.%d.%d) failed\n", 2070c188229SThomas Huth (fn_ip->server_ip >> 24) & 0xFF, (fn_ip->server_ip >> 16) & 0xFF, 2080c188229SThomas Huth (fn_ip->server_ip >> 8) & 0xFF, fn_ip->server_ip & 0xFF); 20929d12216SThomas Huth return -102; 21029d12216SThomas Huth } 21129d12216SThomas Huth if (rc == -4 || rc == -3) { 21229d12216SThomas Huth puts("Can't obtain TFTP server IP address"); 21329d12216SThomas Huth return -107; 21429d12216SThomas Huth } 21529d12216SThomas Huth 2160c188229SThomas Huth printf(" Using TFTP server: "); 217134f0b3dSThomas Huth if (fn_ip->ip_version == 4) { 2180c188229SThomas Huth printf("%d.%d.%d.%d\n", 2190c188229SThomas Huth (fn_ip->server_ip >> 24) & 0xFF, (fn_ip->server_ip >> 16) & 0xFF, 2200c188229SThomas Huth (fn_ip->server_ip >> 8) & 0xFF, fn_ip->server_ip & 0xFF); 221134f0b3dSThomas Huth } else if (fn_ip->ip_version == 6) { 22229d12216SThomas Huth char ip6_str[40]; 2230c188229SThomas Huth ipv6_to_str(fn_ip->server_ip6.addr, ip6_str); 22429d12216SThomas Huth printf("%s\n", ip6_str); 22529d12216SThomas Huth } 22629d12216SThomas Huth 227134f0b3dSThomas Huth if (strlen(fn_ip->filename) > 0) { 2280c188229SThomas Huth printf(" Bootfile name: '%s'\n", fn_ip->filename); 22929d12216SThomas Huth } 23029d12216SThomas Huth 23129d12216SThomas Huth return rc; 23229d12216SThomas Huth } 23329d12216SThomas Huth 2340c188229SThomas Huth static void net_release(filename_ip_t *fn_ip) 2350c188229SThomas Huth { 236134f0b3dSThomas Huth if (fn_ip->ip_version == 4) { 2370c188229SThomas Huth dhcp_send_release(fn_ip->fd); 2380c188229SThomas Huth } 2390c188229SThomas Huth } 2400c188229SThomas Huth 241c4942ee9SThomas Huth /** 242*0d8261b5SThomas Huth * Retrieve the Universally Unique Identifier of the VM. 243*0d8261b5SThomas Huth * @return UUID string, or NULL in case of errors 244*0d8261b5SThomas Huth */ 245*0d8261b5SThomas Huth static const char *get_uuid(void) 246*0d8261b5SThomas Huth { 247*0d8261b5SThomas Huth register int r0 asm("0"); 248*0d8261b5SThomas Huth register int r1 asm("1"); 249*0d8261b5SThomas Huth uint8_t *mem, *buf, uuid[16]; 250*0d8261b5SThomas Huth int i, cc, chk = 0; 251*0d8261b5SThomas Huth static char uuid_str[37]; 252*0d8261b5SThomas Huth 253*0d8261b5SThomas Huth mem = malloc(2 * PAGE_SIZE); 254*0d8261b5SThomas Huth if (!mem) { 255*0d8261b5SThomas Huth puts("Out of memory ... can not get UUID."); 256*0d8261b5SThomas Huth return NULL; 257*0d8261b5SThomas Huth } 258*0d8261b5SThomas Huth buf = (uint8_t *)(((uint64_t)mem + PAGE_SIZE - 1) & ~(PAGE_SIZE - 1)); 259*0d8261b5SThomas Huth memset(buf, 0, PAGE_SIZE); 260*0d8261b5SThomas Huth 261*0d8261b5SThomas Huth /* Get SYSIB 3.2.2 */ 262*0d8261b5SThomas Huth r0 = (3 << 28) | 2; 263*0d8261b5SThomas Huth r1 = 2; 264*0d8261b5SThomas Huth asm volatile(" stsi 0(%[addr])\n" 265*0d8261b5SThomas Huth " ipm %[cc]\n" 266*0d8261b5SThomas Huth " srl %[cc],28\n" 267*0d8261b5SThomas Huth : [cc] "=d" (cc) 268*0d8261b5SThomas Huth : "d" (r0), "d" (r1), [addr] "a" (buf) 269*0d8261b5SThomas Huth : "cc", "memory"); 270*0d8261b5SThomas Huth if (cc) { 271*0d8261b5SThomas Huth return NULL; 272*0d8261b5SThomas Huth } 273*0d8261b5SThomas Huth 274*0d8261b5SThomas Huth for (i = 0; i < 16; i++) { 275*0d8261b5SThomas Huth uuid[i] = buf[STSI322_VMDB_UUID_OFFSET + i]; 276*0d8261b5SThomas Huth chk |= uuid[i]; 277*0d8261b5SThomas Huth } 278*0d8261b5SThomas Huth free(mem); 279*0d8261b5SThomas Huth if (!chk) { 280*0d8261b5SThomas Huth return NULL; 281*0d8261b5SThomas Huth } 282*0d8261b5SThomas Huth 283*0d8261b5SThomas Huth sprintf(uuid_str, "%02x%02x%02x%02x-%02x%02x-%02x%02x-%02x%02x-" 284*0d8261b5SThomas Huth "%02x%02x%02x%02x%02x%02x", uuid[0], uuid[1], uuid[2], uuid[3], 285*0d8261b5SThomas Huth uuid[4], uuid[5], uuid[6], uuid[7], uuid[8], uuid[9], uuid[10], 286*0d8261b5SThomas Huth uuid[11], uuid[12], uuid[13], uuid[14], uuid[15]); 287*0d8261b5SThomas Huth 288*0d8261b5SThomas Huth return uuid_str; 289*0d8261b5SThomas Huth } 290*0d8261b5SThomas Huth 291*0d8261b5SThomas Huth /** 292ec623990SThomas Huth * Load a kernel with initrd (i.e. with the information that we've got from 293ec623990SThomas Huth * a pxelinux.cfg config file) 294ec623990SThomas Huth */ 295ec623990SThomas Huth static int load_kernel_with_initrd(filename_ip_t *fn_ip, 296ec623990SThomas Huth struct pl_cfg_entry *entry) 297ec623990SThomas Huth { 298ec623990SThomas Huth int rc; 299ec623990SThomas Huth 300ec623990SThomas Huth printf("Loading pxelinux.cfg entry '%s'\n", entry->label); 301ec623990SThomas Huth 302ec623990SThomas Huth if (!entry->kernel) { 303ec623990SThomas Huth printf("Kernel entry is missing!\n"); 304ec623990SThomas Huth return -1; 305ec623990SThomas Huth } 306ec623990SThomas Huth 307ec623990SThomas Huth strncpy(fn_ip->filename, entry->kernel, sizeof(fn_ip->filename)); 308ec623990SThomas Huth rc = tftp_load(fn_ip, KERNEL_ADDR, KERNEL_MAX_SIZE); 309ec623990SThomas Huth if (rc < 0) { 310ec623990SThomas Huth return rc; 311ec623990SThomas Huth } 312ec623990SThomas Huth 313ec623990SThomas Huth if (entry->initrd) { 314ec623990SThomas Huth uint64_t iaddr = (rc + 0xfff) & ~0xfffUL; 315ec623990SThomas Huth 316ec623990SThomas Huth strncpy(fn_ip->filename, entry->initrd, sizeof(fn_ip->filename)); 317ec623990SThomas Huth rc = tftp_load(fn_ip, (void *)iaddr, KERNEL_MAX_SIZE - iaddr); 318ec623990SThomas Huth if (rc < 0) { 319ec623990SThomas Huth return rc; 320ec623990SThomas Huth } 321ec623990SThomas Huth /* Patch location and size: */ 322ec623990SThomas Huth *(uint64_t *)0x10408 = iaddr; 323ec623990SThomas Huth *(uint64_t *)0x10410 = rc; 324ec623990SThomas Huth rc += iaddr; 325ec623990SThomas Huth } 326ec623990SThomas Huth 327ec623990SThomas Huth if (entry->append) { 328ec623990SThomas Huth strncpy((char *)0x10480, entry->append, ARCH_COMMAND_LINE_SIZE); 329ec623990SThomas Huth } 330ec623990SThomas Huth 331ec623990SThomas Huth return rc; 332ec623990SThomas Huth } 333ec623990SThomas Huth 334ec623990SThomas Huth #define MAX_PXELINUX_ENTRIES 16 335ec623990SThomas Huth 336ec623990SThomas Huth static int net_try_pxelinux_cfg(filename_ip_t *fn_ip) 337ec623990SThomas Huth { 338ec623990SThomas Huth struct pl_cfg_entry entries[MAX_PXELINUX_ENTRIES]; 339ec623990SThomas Huth int num_ent, def_ent = 0; 340ec623990SThomas Huth 341*0d8261b5SThomas Huth num_ent = pxelinux_load_parse_cfg(fn_ip, mac, get_uuid(), 342*0d8261b5SThomas Huth DEFAULT_TFTP_RETRIES, 343ec623990SThomas Huth cfgbuf, sizeof(cfgbuf), 344ec623990SThomas Huth entries, MAX_PXELINUX_ENTRIES, &def_ent); 345ec623990SThomas Huth if (num_ent > 0) { 346ec623990SThomas Huth return load_kernel_with_initrd(fn_ip, &entries[def_ent]); 347ec623990SThomas Huth } 348ec623990SThomas Huth 349ec623990SThomas Huth return -1; 350ec623990SThomas Huth } 351ec623990SThomas Huth 352ec623990SThomas Huth /** 353c4942ee9SThomas Huth * Load via information from a .INS file (which can be found on CD-ROMs 354c4942ee9SThomas Huth * for example) 355c4942ee9SThomas Huth */ 356c4942ee9SThomas Huth static int handle_ins_cfg(filename_ip_t *fn_ip, char *cfg, int cfgsize) 357c4942ee9SThomas Huth { 358c4942ee9SThomas Huth char *ptr; 359c4942ee9SThomas Huth int rc = -1, llen; 360c4942ee9SThomas Huth void *destaddr; 361c4942ee9SThomas Huth char *insbuf = cfg; 362c4942ee9SThomas Huth 363c4942ee9SThomas Huth ptr = strchr(insbuf, '\n'); 364c4942ee9SThomas Huth if (!ptr) { 365c4942ee9SThomas Huth puts("Does not seem to be a valid .INS file"); 366c4942ee9SThomas Huth return -1; 367c4942ee9SThomas Huth } 368c4942ee9SThomas Huth 369c4942ee9SThomas Huth *ptr = 0; 370c4942ee9SThomas Huth printf("\nParsing .INS file:\n %s\n", &insbuf[2]); 371c4942ee9SThomas Huth 372c4942ee9SThomas Huth insbuf = ptr + 1; 373c4942ee9SThomas Huth while (*insbuf && insbuf < cfg + cfgsize) { 374c4942ee9SThomas Huth ptr = strchr(insbuf, '\n'); 375c4942ee9SThomas Huth if (ptr) { 376c4942ee9SThomas Huth *ptr = 0; 377c4942ee9SThomas Huth } 378c4942ee9SThomas Huth llen = strlen(insbuf); 379c4942ee9SThomas Huth if (!llen) { 380c4942ee9SThomas Huth insbuf = ptr + 1; 381c4942ee9SThomas Huth continue; 382c4942ee9SThomas Huth } 383c4942ee9SThomas Huth ptr = strchr(insbuf, ' '); 384c4942ee9SThomas Huth if (!ptr) { 385c4942ee9SThomas Huth puts("Missing space separator in .INS file"); 386c4942ee9SThomas Huth return -1; 387c4942ee9SThomas Huth } 388c4942ee9SThomas Huth *ptr = 0; 389134f0b3dSThomas Huth strncpy(fn_ip->filename, insbuf, sizeof(fn_ip->filename)); 390c4942ee9SThomas Huth destaddr = (char *)atol(ptr + 1); 391c4942ee9SThomas Huth rc = tftp_load(fn_ip, destaddr, (long)_start - (long)destaddr); 392c4942ee9SThomas Huth if (rc <= 0) { 393c4942ee9SThomas Huth break; 394c4942ee9SThomas Huth } 395c4942ee9SThomas Huth insbuf += llen + 1; 396c4942ee9SThomas Huth } 397c4942ee9SThomas Huth 398c4942ee9SThomas Huth return rc; 399c4942ee9SThomas Huth } 400c4942ee9SThomas Huth 401c4942ee9SThomas Huth static int net_try_direct_tftp_load(filename_ip_t *fn_ip) 402c4942ee9SThomas Huth { 403c4942ee9SThomas Huth int rc; 404c4942ee9SThomas Huth void *loadaddr = (void *)0x2000; /* Load right after the low-core */ 405c4942ee9SThomas Huth 406c4942ee9SThomas Huth rc = tftp_load(fn_ip, loadaddr, KERNEL_MAX_SIZE - (long)loadaddr); 407c4942ee9SThomas Huth if (rc < 0) { 408c4942ee9SThomas Huth return rc; 409c4942ee9SThomas Huth } else if (rc < 8) { 410c4942ee9SThomas Huth printf("'%s' is too small (%i bytes only).\n", fn_ip->filename, rc); 411c4942ee9SThomas Huth return -1; 412c4942ee9SThomas Huth } 413c4942ee9SThomas Huth 414c4942ee9SThomas Huth /* Check whether it is a configuration file instead of a kernel */ 415c4942ee9SThomas Huth if (rc < sizeof(cfgbuf) - 1) { 416c4942ee9SThomas Huth memcpy(cfgbuf, loadaddr, rc); 417c4942ee9SThomas Huth cfgbuf[rc] = 0; /* Make sure that it is NUL-terminated */ 418c4942ee9SThomas Huth if (!strncmp("* ", cfgbuf, 2)) { 419c4942ee9SThomas Huth return handle_ins_cfg(fn_ip, cfgbuf, rc); 420c4942ee9SThomas Huth } 421ec623990SThomas Huth /* 422ec623990SThomas Huth * pxelinux.cfg support via bootfile name is just here for developers' 423ec623990SThomas Huth * convenience (it eases testing with the built-in DHCP server of QEMU 424ec623990SThomas Huth * that does not support RFC 5071). The official way to configure a 425ec623990SThomas Huth * pxelinux.cfg file name is to use DHCP options 209 and 210 instead. 426ec623990SThomas Huth * So only use the pxelinux.cfg parser here for files that start with 427ec623990SThomas Huth * a magic comment string. 428ec623990SThomas Huth */ 429ec623990SThomas Huth if (!strncasecmp("# pxelinux", cfgbuf, 10)) { 430ec623990SThomas Huth struct pl_cfg_entry entries[MAX_PXELINUX_ENTRIES]; 431ec623990SThomas Huth int num_ent, def_ent = 0; 432ec623990SThomas Huth 433ec623990SThomas Huth num_ent = pxelinux_parse_cfg(cfgbuf, sizeof(cfgbuf), entries, 434ec623990SThomas Huth MAX_PXELINUX_ENTRIES, &def_ent); 435ec623990SThomas Huth if (num_ent <= 0) { 436ec623990SThomas Huth return -1; 437ec623990SThomas Huth } 438ec623990SThomas Huth return load_kernel_with_initrd(fn_ip, &entries[def_ent]); 439ec623990SThomas Huth } 440c4942ee9SThomas Huth } 441c4942ee9SThomas Huth 442c4942ee9SThomas Huth /* Move kernel to right location */ 443c4942ee9SThomas Huth memmove(KERNEL_ADDR, loadaddr, rc); 444c4942ee9SThomas Huth 445c4942ee9SThomas Huth return rc; 446c4942ee9SThomas Huth } 447c4942ee9SThomas Huth 4483e4415a7SThomas Huth void panic(const char *string) 4493e4415a7SThomas Huth { 4503e4415a7SThomas Huth sclp_print(string); 4513e4415a7SThomas Huth for (;;) { 4523e4415a7SThomas Huth disabled_wait(); 4533e4415a7SThomas Huth } 4543e4415a7SThomas Huth } 4553e4415a7SThomas Huth 4569a848adfSThomas Huth void write_subsystem_identification(void) 4579a848adfSThomas Huth { 4589a848adfSThomas Huth SubChannelId *schid = (SubChannelId *) 184; 4599a848adfSThomas Huth uint32_t *zeroes = (uint32_t *) 188; 4609a848adfSThomas Huth 4619a848adfSThomas Huth *schid = net_schid; 4629a848adfSThomas Huth *zeroes = 0; 4639a848adfSThomas Huth } 4649a848adfSThomas Huth 4653e4415a7SThomas Huth static bool find_net_dev(Schib *schib, int dev_no) 4663e4415a7SThomas Huth { 4673e4415a7SThomas Huth int i, r; 4683e4415a7SThomas Huth 4693e4415a7SThomas Huth for (i = 0; i < 0x10000; i++) { 4703e4415a7SThomas Huth net_schid.sch_no = i; 4713e4415a7SThomas Huth r = stsch_err(net_schid, schib); 4723e4415a7SThomas Huth if (r == 3 || r == -EIO) { 4733e4415a7SThomas Huth break; 4743e4415a7SThomas Huth } 4753e4415a7SThomas Huth if (!schib->pmcw.dnv) { 4763e4415a7SThomas Huth continue; 4773e4415a7SThomas Huth } 4783e4415a7SThomas Huth if (!virtio_is_supported(net_schid)) { 4793e4415a7SThomas Huth continue; 4803e4415a7SThomas Huth } 4813e4415a7SThomas Huth if (virtio_get_device_type() != VIRTIO_ID_NET) { 4823e4415a7SThomas Huth continue; 4833e4415a7SThomas Huth } 4843e4415a7SThomas Huth if (dev_no < 0 || schib->pmcw.dev == dev_no) { 4853e4415a7SThomas Huth return true; 4863e4415a7SThomas Huth } 4873e4415a7SThomas Huth } 4883e4415a7SThomas Huth 4893e4415a7SThomas Huth return false; 4903e4415a7SThomas Huth } 4913e4415a7SThomas Huth 4923e4415a7SThomas Huth static void virtio_setup(void) 4933e4415a7SThomas Huth { 4943e4415a7SThomas Huth Schib schib; 4953e4415a7SThomas Huth int ssid; 4963e4415a7SThomas Huth bool found = false; 4973e4415a7SThomas Huth uint16_t dev_no; 4983e4415a7SThomas Huth 4993e4415a7SThomas Huth /* 5003e4415a7SThomas Huth * We unconditionally enable mss support. In every sane configuration, 5013e4415a7SThomas Huth * this will succeed; and even if it doesn't, stsch_err() can deal 5023e4415a7SThomas Huth * with the consequences. 5033e4415a7SThomas Huth */ 5043e4415a7SThomas Huth enable_mss_facility(); 5053e4415a7SThomas Huth 5063e4415a7SThomas Huth if (store_iplb(&iplb)) { 5073e4415a7SThomas Huth IPL_assert(iplb.pbt == S390_IPL_TYPE_CCW, "IPL_TYPE_CCW expected"); 5083e4415a7SThomas Huth dev_no = iplb.ccw.devno; 5093e4415a7SThomas Huth debug_print_int("device no. ", dev_no); 5103e4415a7SThomas Huth net_schid.ssid = iplb.ccw.ssid & 0x3; 5113e4415a7SThomas Huth debug_print_int("ssid ", net_schid.ssid); 5123e4415a7SThomas Huth found = find_net_dev(&schib, dev_no); 5133e4415a7SThomas Huth } else { 5143e4415a7SThomas Huth for (ssid = 0; ssid < 0x3; ssid++) { 5153e4415a7SThomas Huth net_schid.ssid = ssid; 5163e4415a7SThomas Huth found = find_net_dev(&schib, -1); 5173e4415a7SThomas Huth if (found) { 5183e4415a7SThomas Huth break; 5193e4415a7SThomas Huth } 5203e4415a7SThomas Huth } 5213e4415a7SThomas Huth } 5223e4415a7SThomas Huth 5233e4415a7SThomas Huth IPL_assert(found, "No virtio net device found"); 5243e4415a7SThomas Huth } 5253e4415a7SThomas Huth 5263e4415a7SThomas Huth void main(void) 5273e4415a7SThomas Huth { 5280c188229SThomas Huth filename_ip_t fn_ip; 529c4942ee9SThomas Huth int rc, fnlen; 53029d12216SThomas Huth 5313e4415a7SThomas Huth sclp_setup(); 5323e4415a7SThomas Huth sclp_print("Network boot starting...\n"); 5333e4415a7SThomas Huth 5343e4415a7SThomas Huth virtio_setup(); 5353e4415a7SThomas Huth 5360c188229SThomas Huth rc = net_init(&fn_ip); 5370c188229SThomas Huth if (rc) { 5380c188229SThomas Huth panic("Network initialization failed. Halting.\n"); 5390c188229SThomas Huth } 5400c188229SThomas Huth 541134f0b3dSThomas Huth fnlen = strlen(fn_ip.filename); 542c4942ee9SThomas Huth if (fnlen > 0 && fn_ip.filename[fnlen - 1] != '/') { 543c4942ee9SThomas Huth rc = net_try_direct_tftp_load(&fn_ip); 544c4942ee9SThomas Huth } 545ec623990SThomas Huth if (rc <= 0) { 546ec623990SThomas Huth rc = net_try_pxelinux_cfg(&fn_ip); 547ec623990SThomas Huth } 5480c188229SThomas Huth 5490c188229SThomas Huth net_release(&fn_ip); 5500c188229SThomas Huth 55129d12216SThomas Huth if (rc > 0) { 55229d12216SThomas Huth sclp_print("Network loading done, starting kernel...\n"); 5539a848adfSThomas Huth jump_to_low_kernel(); 55429d12216SThomas Huth } 55529d12216SThomas Huth 5563e4415a7SThomas Huth panic("Failed to load OS from network\n"); 5573e4415a7SThomas Huth } 558