src/nbserver.c

// Copyright 2016 The Fuchsia Authors. All rights reserved.
// Use of this source code is governed by a BSD-style license that can be
// found in the LICENSE file.

#include <arpa/inet.h>
#include <netinet/in.h>
#include <sys/socket.h>
#include <sys/types.h>

#include <fcntl.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>

#include <errno.h>
#include <stdint.h>

#include "netboot.h"

static uint32_t cookie = 1;
static char* appname;

static int io(int s, nbmsg* msg, size_t len, nbmsg* ack) {
    int retries = 5;
    int r;

    msg->magic = NB_MAGIC;
    msg->cookie = cookie++;

    for (;;) {
        r = write(s, msg, len);
        if (r < 0) {
            if ((errno == EAGAIN) || (errno == EWOULDBLOCK)) {
                continue;
            }
            fprintf(stderr, "\n%s: socket write error %d\n", appname, errno);
            return -1;
        }
    again:
        r = read(s, ack, 2048);
        if (r < 0) {
            if ((errno == EAGAIN) || (errno == EWOULDBLOCK)) {
                retries--;
                if (retries > 0) {
                    fprintf(stderr, "T");
                    continue;
                }
                fprintf(stderr, "\n%s: timed out\n", appname);
            } else {
                fprintf(stderr, "\n%s: socket read error %d\n", appname, errno);
            }
            return -1;
        }
        if (r < sizeof(nbmsg)) {
            fprintf(stderr, "Z");
            goto again;
        }
        if (ack->magic != NB_MAGIC) {
            fprintf(stderr, "?");
            goto again;
        }
        if (ack->cookie != msg->cookie) {
            fprintf(stderr, "C");
            goto again;
        }
        if (ack->arg != msg->arg) {
            fprintf(stderr, "A");
            goto again;
        }
        if (ack->cmd == NB_ACK)
            return 0;
        fprintf(stderr, "?");
        goto again;
    }
}

static void xfer(struct sockaddr_in6* addr, const char* fn) {
    char msgbuf[2048];
    char ackbuf[2048];
    char tmp[INET6_ADDRSTRLEN];
    struct timeval tv;
    nbmsg* msg = (void*)msgbuf;
    nbmsg* ack = (void*)ackbuf;
    FILE* fp;
    int s, r;
    int count = 0;

    if ((fp = fopen(fn, "rb")) == NULL) {
        return;
    }
    if ((s = socket(AF_INET6, SOCK_DGRAM, IPPROTO_UDP)) < 0) {
        fprintf(stderr, "%s: cannot create socket %d\n", appname, errno);
        goto done;
    }
    tv.tv_sec = 0;
    tv.tv_usec = 250 * 1000;
    setsockopt(s, SOL_SOCKET, SO_RCVTIMEO, &tv, sizeof(tv));
    if (connect(s, (void*)addr, sizeof(*addr)) < 0) {
        fprintf(stderr, "%s: cannot connect to [%s]%d\n", appname,
                inet_ntop(AF_INET6, &addr->sin6_addr, tmp, sizeof(tmp)),
                ntohs(addr->sin6_port));
        goto done;
    }

    msg->cmd = NB_SEND_FILE;
    msg->arg = 0;
    strcpy((void*)msg->data, "kernel.bin");
    if (io(s, msg, sizeof(nbmsg) + sizeof("kernel.bin"), ack)) {
        fprintf(stderr, "%s: failed to start transfer\n", appname);
        goto done;
    }

    msg->cmd = NB_DATA;
    msg->arg = 0;
    do {
        r = fread(msg->data, 1, 1024, fp);
        if (r == 0) {
            if (ferror(fp)) {
                fprintf(stderr, "\n%s: error: reading '%s'\n", appname, fn);
                goto done;
            }
            break;
        }
        count += r;
        if (count >= (32 * 1024)) {
            count = 0;
            fprintf(stderr, "#");
        }
        if (io(s, msg, sizeof(nbmsg) + r, ack)) {
            fprintf(stderr, "\n%s: error: sending '%s'\n", appname, fn);
            goto done;
        }
        msg->arg += r;
    } while (r != 0);

    msg->cmd = NB_BOOT;
    msg->arg = 0;
    if (io(s, msg, sizeof(nbmsg), ack)) {
        fprintf(stderr, "\n%s: failed to send boot command\n", appname);
    } else {
        fprintf(stderr, "\n%s: sent boot command\n", appname);
    }
done:
    if (s >= 0)
        close(s);
    if (fp != NULL)
        fclose(fp);
}

void usage(void) {
    fprintf(stderr,
            "usage:   %s [ <option> ]* <filename>\n"
            "\n"
            "options: -1  only boot once, then exit\n",
            appname);
    exit(1);
}

void drain(int fd) {
    char buf[4096];
    if (fcntl(fd, F_SETFL, O_NONBLOCK) == 0) {
        while (read(fd, buf, sizeof(buf)) > 0)
            ;
        fcntl(fd, F_SETFL, 0);
    }
}

int main(int argc, char** argv) {
    struct sockaddr_in6 addr;
    char tmp[INET6_ADDRSTRLEN];
    int r, s, n = 1;
    const char* fn = NULL;
    int once = 0;

    appname = argv[0];

    while (argc > 1) {
        if (argv[1][0] != '-') {
            if (fn != NULL)
                usage();
            fn = argv[1];
        } else if (!strcmp(argv[1], "-1")) {
            once = 1;
        } else {
            usage();
        }
        argc--;
        argv++;
    }
    if (fn == NULL) {
        usage();
    }

    memset(&addr, 0, sizeof(addr));
    addr.sin6_family = AF_INET6;
    addr.sin6_port = htons(NB_ADVERT_PORT);

    s = socket(AF_INET6, SOCK_DGRAM, IPPROTO_UDP);
    if (s < 0) {
        fprintf(stderr, "%s: cannot create socket %d\n", appname, s);
        return -1;
    }
    setsockopt(s, SOL_SOCKET, SO_REUSEADDR, &n, sizeof(n));
    if ((r = bind(s, (void*)&addr, sizeof(addr))) < 0) {
        fprintf(stderr, "%s: cannot bind to [%s]%d %d\n", appname,
                inet_ntop(AF_INET6, &addr.sin6_addr, tmp, sizeof(tmp)),
                ntohs(addr.sin6_port), r);
        return -1;
    }

    fprintf(stderr, "%s: listening on [%s]%d\n", appname,
            inet_ntop(AF_INET6, &addr.sin6_addr, tmp, sizeof(tmp)),
            ntohs(addr.sin6_port));
    for (;;) {
        struct sockaddr_in6 ra;
        socklen_t rlen;
        char buf[4096];
        nbmsg* msg = (void*)buf;
        rlen = sizeof(ra);
        r = recvfrom(s, buf, 4096, 0, (void*)&ra, &rlen);
        if (r < 0) {
            fprintf(stderr, "%s: socket read error %d\n", appname, r);
            break;
        }
        if (r < sizeof(nbmsg))
            continue;
        if ((ra.sin6_addr.s6_addr[0] != 0xFE) || (ra.sin6_addr.s6_addr[1] != 0x80)) {
            fprintf(stderr, "ignoring non-link-local message\n");
            continue;
        }
        if (msg->magic != NB_MAGIC)
            continue;
        if (msg->cmd != NB_ADVERTISE)
            continue;
        fprintf(stderr, "%s: got beacon from [%s]%d\n", appname,
                inet_ntop(AF_INET6, &ra.sin6_addr, tmp, sizeof(tmp)),
                ntohs(ra.sin6_port));
        fprintf(stderr, "%s: sending '%s'...\n", appname, fn);
        xfer(&ra, fn);
        if (once) {
            break;
        }
        drain(s);
    }

    return 0;
}