sparc64/boot1/boot1.c

199767f8919635c4928607450d9e0abb932109ceToomas Soome/*-
199767f8919635c4928607450d9e0abb932109ceToomas Soome * Copyright (c) 1998 Robert Nordier
199767f8919635c4928607450d9e0abb932109ceToomas Soome * All rights reserved.
199767f8919635c4928607450d9e0abb932109ceToomas Soome * Copyright (c) 2001 Robert Drehmel
199767f8919635c4928607450d9e0abb932109ceToomas Soome * All rights reserved.
199767f8919635c4928607450d9e0abb932109ceToomas Soome *
199767f8919635c4928607450d9e0abb932109ceToomas Soome * Redistribution and use in source and binary forms are freely
199767f8919635c4928607450d9e0abb932109ceToomas Soome * permitted provided that the above copyright notice and this
199767f8919635c4928607450d9e0abb932109ceToomas Soome * paragraph and the following disclaimer are duplicated in all
199767f8919635c4928607450d9e0abb932109ceToomas Soome * such forms.
199767f8919635c4928607450d9e0abb932109ceToomas Soome *
199767f8919635c4928607450d9e0abb932109ceToomas Soome * This software is provided "AS IS" and without any express or
199767f8919635c4928607450d9e0abb932109ceToomas Soome * implied warranties, including, without limitation, the implied
199767f8919635c4928607450d9e0abb932109ceToomas Soome * warranties of merchantability and fitness for a particular
199767f8919635c4928607450d9e0abb932109ceToomas Soome * purpose.
199767f8919635c4928607450d9e0abb932109ceToomas Soome */
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <sys/cdefs.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome__FBSDID("$FreeBSD$");
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <sys/param.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <sys/dirent.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <machine/elf.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include <machine/stdarg.h>
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include "paths.h"
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#define READ_BUF_SIZE   8192
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soometypedef int putc_func_t(char c, void *arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soometypedef int32_t ofwh_t;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestruct sp_data {
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char    *sp_buf;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    u_int   sp_len;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    u_int   sp_size;
199767f8919635c4928607450d9e0abb932109ceToomas Soome};
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic const char digits[] = "0123456789abcdef";
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic char bootpath[128];
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic char bootargs[128];
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic ofwh_t bootdev;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic uint32_t fs_off;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomeint main(int ac, char **av);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void exit(int) __dead2;
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void usage(void);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#ifdef ZFSBOOT
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void loadzfs(void);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int zbread(char *buf, off_t off, size_t bytes);
199767f8919635c4928607450d9e0abb932109ceToomas Soome#else
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void load(const char *);
199767f8919635c4928607450d9e0abb932109ceToomas Soome#endif
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void bcopy(const void *src, void *dst, size_t len);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void bzero(void *b, size_t len);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int domount(const char *device);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int dskread(void *buf, u_int64_t lba, int nblk);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void panic(const char *fmt, ...) __dead2;
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int printf(const char *fmt, ...);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int putchar(char c, void *arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int vprintf(const char *fmt, va_list ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int vsnprintf(char *str, size_t sz, const char *fmt, va_list ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int __printf(const char *fmt, putc_func_t *putc, void *arg, va_list ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int __puts(const char *s, putc_func_t *putc, void *arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int __sputc(char c, void *arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic char *__uitoa(char *buf, u_int val, int base);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic char *__ultoa(char *buf, u_long val, int base);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome/*
199767f8919635c4928607450d9e0abb932109ceToomas Soome * Open Firmware interface functions
199767f8919635c4928607450d9e0abb932109ceToomas Soome */
199767f8919635c4928607450d9e0abb932109ceToomas Soometypedef u_int64_t   ofwcell_t;
199767f8919635c4928607450d9e0abb932109ceToomas Soometypedef u_int32_t   u_ofwh_t;
199767f8919635c4928607450d9e0abb932109ceToomas Soometypedef int (*ofwfp_t)(ofwcell_t []);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic ofwfp_t ofw;         /* the PROM Open Firmware entry */
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomevoid ofw_init(int, int, int, int, ofwfp_t);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic ofwh_t ofw_finddevice(const char *);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic ofwh_t ofw_open(const char *);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int ofw_getprop(ofwh_t, const char *, void *, size_t);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int ofw_read(ofwh_t, void *, size_t);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int ofw_write(ofwh_t, const void *, size_t);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int ofw_seek(ofwh_t, u_int64_t);
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void ofw_exit(void) __dead2;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic ofwh_t stdinh, stdouth;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome/*
199767f8919635c4928607450d9e0abb932109ceToomas Soome * This has to stay here, as the PROM seems to ignore the
199767f8919635c4928607450d9e0abb932109ceToomas Soome * entry point specified in the a.out header.  (or elftoaout is broken)
199767f8919635c4928607450d9e0abb932109ceToomas Soome */
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomevoid
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_init(int d, int d1, int d2, int d3, ofwfp_t ofwaddr)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwh_t chosenh;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *av[16];
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *p;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int ac;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw = ofwaddr;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    chosenh = ofw_finddevice("/chosen");
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_getprop(chosenh, "stdin", &stdinh, sizeof(stdinh));
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_getprop(chosenh, "stdout", &stdouth, sizeof(stdouth));
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_getprop(chosenh, "bootargs", bootargs, sizeof(bootargs));
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_getprop(chosenh, "bootpath", bootpath, sizeof(bootpath));
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    bootargs[sizeof(bootargs) - 1] = '\0';
199767f8919635c4928607450d9e0abb932109ceToomas Soome    bootpath[sizeof(bootpath) - 1] = '\0';
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ac = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    p = bootargs;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    for (;;) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        while (*p == ' ' && *p != '\0')
199767f8919635c4928607450d9e0abb932109ceToomas Soome            p++;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (*p == '\0' || ac >= 16)
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        av[ac++] = p;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        while (*p != ' ' && *p != '\0')
199767f8919635c4928607450d9e0abb932109ceToomas Soome            p++;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (*p != '\0')
199767f8919635c4928607450d9e0abb932109ceToomas Soome            *p++ = '\0';
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    exit(main(ac, av));
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic ofwh_t
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_finddevice(const char *name)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwcell_t args[] = {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)"finddevice",
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)name,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        0
199767f8919635c4928607450d9e0abb932109ceToomas Soome    };
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((*ofw)(args)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("ofw_finddevice: name=\"%s\"\n", name);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (args[4]);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_getprop(ofwh_t ofwh, const char *name, void *buf, size_t len)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwcell_t args[] = {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)"getprop",
199767f8919635c4928607450d9e0abb932109ceToomas Soome        4,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (u_ofwh_t)ofwh,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)name,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)buf,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        len,
199767f8919635c4928607450d9e0abb932109ceToomas Soome    0
199767f8919635c4928607450d9e0abb932109ceToomas Soome    };
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((*ofw)(args)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("ofw_getprop: ofwh=0x%x buf=%p len=%u\n",
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ofwh, buf, len);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic ofwh_t
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_open(const char *path)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwcell_t args[] = {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)"open",
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)path,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        0
199767f8919635c4928607450d9e0abb932109ceToomas Soome    };
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((*ofw)(args)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("ofw_open: path=\"%s\"\n", path);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (-1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (args[4]);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_close(ofwh_t devh)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwcell_t args[] = {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)"close",
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        0,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (u_ofwh_t)devh
199767f8919635c4928607450d9e0abb932109ceToomas Soome    };
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((*ofw)(args)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("ofw_close: devh=0x%x\n", devh);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_read(ofwh_t devh, void *buf, size_t len)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwcell_t args[] = {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)"read",
199767f8919635c4928607450d9e0abb932109ceToomas Soome        3,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (u_ofwh_t)devh,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)buf,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        len,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        0
199767f8919635c4928607450d9e0abb932109ceToomas Soome    };
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((*ofw)(args)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("ofw_read: devh=0x%x buf=%p len=%u\n", devh, buf, len);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_write(ofwh_t devh, const void *buf, size_t len)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwcell_t args[] = {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)"write",
199767f8919635c4928607450d9e0abb932109ceToomas Soome        3,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (u_ofwh_t)devh,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)buf,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        len,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        0
199767f8919635c4928607450d9e0abb932109ceToomas Soome    };
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((*ofw)(args)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("ofw_write: devh=0x%x buf=%p len=%u\n", devh, buf, len);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_seek(ofwh_t devh, u_int64_t off)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwcell_t args[] = {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (ofwcell_t)"seek",
199767f8919635c4928607450d9e0abb932109ceToomas Soome        3,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        1,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (u_ofwh_t)devh,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        off >> 32,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        off,
199767f8919635c4928607450d9e0abb932109ceToomas Soome        0
199767f8919635c4928607450d9e0abb932109ceToomas Soome    };
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((*ofw)(args)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("ofw_seek: devh=0x%x off=0x%lx\n", devh, off);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomeofw_exit(void)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofwcell_t args[3];
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    args[0] = (ofwcell_t)"exit";
199767f8919635c4928607450d9e0abb932109ceToomas Soome    args[1] = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    args[2] = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    for (;;)
199767f8919635c4928607450d9e0abb932109ceToomas Soome        (*ofw)(args);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomebcopy(const void *src, void *dst, size_t len)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    const char *s = src;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *d = dst;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    while (len-- != 0)
199767f8919635c4928607450d9e0abb932109ceToomas Soome        *d++ = *s++;
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomememcpy(void *dst, const void *src, size_t len)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    bcopy(src, dst, len);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomebzero(void *b, size_t len)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *p = b;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    while (len-- != 0)
199767f8919635c4928607450d9e0abb932109ceToomas Soome        *p++ = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomestrcmp(const char *s1, const char *s2)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    for (; *s1 == *s2 && *s1; s1++, s2++)
199767f8919635c4928607450d9e0abb932109ceToomas Soome        ;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return ((u_char)*s1 - (u_char)*s2);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomeint
199767f8919635c4928607450d9e0abb932109ceToomas Soomemain(int ac, char **av)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    const char *path;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int i;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    path = PATH_LOADER;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    for (i = 0; i < ac; i++) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        switch (av[i][0]) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case '-':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            switch (av[i][1]) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome            default:
199767f8919635c4928607450d9e0abb932109ceToomas Soome                usage();
199767f8919635c4928607450d9e0abb932109ceToomas Soome            }
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        default:
199767f8919635c4928607450d9e0abb932109ceToomas Soome            path = av[i];
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#ifdef ZFSBOOT
199767f8919635c4928607450d9e0abb932109ceToomas Soome    printf(" \n>> FreeBSD/sparc64 ZFS boot block\n   Boot path:   %s\n",
199767f8919635c4928607450d9e0abb932109ceToomas Soome        bootpath);
199767f8919635c4928607450d9e0abb932109ceToomas Soome#else
199767f8919635c4928607450d9e0abb932109ceToomas Soome    printf(" \n>> FreeBSD/sparc64 boot block\n   Boot path:   %s\n"
199767f8919635c4928607450d9e0abb932109ceToomas Soome        "   Boot loader: %s\n", bootpath, path);
199767f8919635c4928607450d9e0abb932109ceToomas Soome#endif
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if (domount(bootpath) == -1)
199767f8919635c4928607450d9e0abb932109ceToomas Soome        panic("domount");
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#ifdef ZFSBOOT
199767f8919635c4928607450d9e0abb932109ceToomas Soome    loadzfs();
199767f8919635c4928607450d9e0abb932109ceToomas Soome#else
199767f8919635c4928607450d9e0abb932109ceToomas Soome    load(path);
199767f8919635c4928607450d9e0abb932109ceToomas Soome#endif
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomeusage(void)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    printf("usage: boot device [/path/to/loader]\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome    exit(1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomeexit(int code)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_exit();
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#ifdef ZFSBOOT
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#define VDEV_BOOT_OFFSET    (2 * 256 * 1024)
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic char zbuf[READ_BUF_SIZE];
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomezbread(char *buf, off_t off, size_t bytes)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    size_t len;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    off_t poff;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    off_t soff;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *p;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    unsigned int nb;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    unsigned int lb;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    p = buf;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    soff = VDEV_BOOT_OFFSET + off;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    lb = (soff + bytes + DEV_BSIZE - 1) / DEV_BSIZE;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    poff = soff;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    while (poff < soff + bytes) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        nb = lb - poff / DEV_BSIZE;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (nb > READ_BUF_SIZE / DEV_BSIZE)
199767f8919635c4928607450d9e0abb932109ceToomas Soome            nb = READ_BUF_SIZE / DEV_BSIZE;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (dskread(zbuf, poff / DEV_BSIZE, nb))
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if ((poff / DEV_BSIZE + nb) * DEV_BSIZE > soff + bytes)
199767f8919635c4928607450d9e0abb932109ceToomas Soome            len = soff + bytes - poff;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        else
199767f8919635c4928607450d9e0abb932109ceToomas Soome            len = (poff / DEV_BSIZE + nb) * DEV_BSIZE - poff;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        memcpy(p, zbuf + poff % DEV_BSIZE, len);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        p += len;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        poff += len;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (poff - soff);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomeloadzfs(void)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    Elf64_Ehdr eh;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    Elf64_Phdr ph;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    caddr_t p;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int i;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if (zbread((char *)&eh, 0, sizeof(eh)) != sizeof(eh)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("Can't read elf header\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if (!IS_ELF(eh)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("Not an ELF file\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    for (i = 0; i < eh.e_phnum; i++) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        fs_off = eh.e_phoff + i * eh.e_phentsize;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (zbread((char *)&ph, fs_off, sizeof(ph)) != sizeof(ph)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome            printf("Can't read program header %d\n", i);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        }
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (ph.p_type != PT_LOAD)
199767f8919635c4928607450d9e0abb932109ceToomas Soome            continue;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        fs_off = ph.p_offset;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        p = (caddr_t)ph.p_vaddr;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (zbread(p, fs_off, ph.p_filesz) != ph.p_filesz) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome            printf("Can't read content of section %d\n", i);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        }
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (ph.p_filesz != ph.p_memsz)
199767f8919635c4928607450d9e0abb932109ceToomas Soome            bzero(p + ph.p_filesz, ph.p_memsz - ph.p_filesz);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_close(bootdev);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    (*(void (*)(int, int, int, int, ofwfp_t))eh.e_entry)(0, 0, 0, 0, ofw);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#else
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#include "ufsread.c"
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic struct dmadat __dmadat;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomeload(const char *fname)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    Elf64_Ehdr eh;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    Elf64_Phdr ph;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    caddr_t p;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ufs_ino_t ino;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int i;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((ino = lookup(fname)) == 0) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("File %s not found\n", fname);
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if (fsread(ino, &eh, sizeof(eh)) != sizeof(eh)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("Can't read elf header\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if (!IS_ELF(eh)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("Not an ELF file\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    for (i = 0; i < eh.e_phnum; i++) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        fs_off = eh.e_phoff + i * eh.e_phentsize;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (fsread(ino, &ph, sizeof(ph)) != sizeof(ph)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome            printf("Can't read program header %d\n", i);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        }
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (ph.p_type != PT_LOAD)
199767f8919635c4928607450d9e0abb932109ceToomas Soome            continue;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        fs_off = ph.p_offset;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        p = (caddr_t)ph.p_vaddr;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (fsread(ino, p, ph.p_filesz) != ph.p_filesz) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome            printf("Can't read content of section %d\n", i);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            return;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        }
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (ph.p_filesz != ph.p_memsz)
199767f8919635c4928607450d9e0abb932109ceToomas Soome            bzero(p + ph.p_filesz, ph.p_memsz - ph.p_filesz);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_close(bootdev);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    (*(void (*)(int, int, int, int, ofwfp_t))eh.e_entry)(0, 0, 0, 0, ofw);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome#endif /* ZFSBOOT */
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomedomount(const char *device)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if ((bootdev = ofw_open(device)) == -1) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("domount: can't open device\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (-1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome#ifndef ZFSBOOT
199767f8919635c4928607450d9e0abb932109ceToomas Soome    dmadat = &__dmadat;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if (fsread(0, NULL, 0)) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        printf("domount: can't read superblock\n");
199767f8919635c4928607450d9e0abb932109ceToomas Soome        return (-1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome#endif
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomedskread(void *buf, u_int64_t lba, int nblk)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    /*
199767f8919635c4928607450d9e0abb932109ceToomas Soome     * The Open Firmware should open the correct partition for us.
199767f8919635c4928607450d9e0abb932109ceToomas Soome     * That means, if we read from offset zero on an open instance handle,
199767f8919635c4928607450d9e0abb932109ceToomas Soome     * we should read from offset zero of that partition.
199767f8919635c4928607450d9e0abb932109ceToomas Soome     */
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_seek(bootdev, lba * DEV_BSIZE);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_read(bootdev, buf, nblk * DEV_BSIZE);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic void
199767f8919635c4928607450d9e0abb932109ceToomas Soomepanic(const char *fmt, ...)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char buf[128];
199767f8919635c4928607450d9e0abb932109ceToomas Soome    va_list ap;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    va_start(ap, fmt);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    vsnprintf(buf, sizeof buf, fmt, ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    printf("panic: %s\n", buf);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    va_end(ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    exit(1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomeprintf(const char *fmt, ...)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    va_list ap;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int ret;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    va_start(ap, fmt);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ret = vprintf(fmt, ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    va_end(ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (ret);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomeputchar(char c, void *arg)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char buf;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if (c == '\n') {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        buf = '\r';
199767f8919635c4928607450d9e0abb932109ceToomas Soome        ofw_write(stdouth, &buf, 1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    buf = c;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ofw_write(stdouth, &buf, 1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomevprintf(const char *fmt, va_list ap)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int ret;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ret = __printf(fmt, putchar, 0, ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (ret);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soomevsnprintf(char *str, size_t sz, const char *fmt, va_list ap)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    struct sp_data sp;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int ret;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    sp.sp_buf = str;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    sp.sp_len = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    sp.sp_size = sz;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ret = __printf(fmt, __sputc, &sp, ap);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (ret);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soome__printf(const char *fmt, putc_func_t *putc, void *arg, va_list ap)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char buf[(sizeof(long) * 8) + 1];
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *nbuf;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    u_long ul;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    u_int ui;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int lflag;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int sflag;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *s;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int pad;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int ret;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int c;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    nbuf = &buf[sizeof buf - 1];
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ret = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    while ((c = *fmt++) != 0) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        if (c != '%') {
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += putc(c, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            continue;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        }
199767f8919635c4928607450d9e0abb932109ceToomas Soome        lflag = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        sflag = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        pad = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soomereswitch:   c = *fmt++;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        switch (c) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case '#':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            sflag = 1;
199767f8919635c4928607450d9e0abb932109ceToomas Soome            goto reswitch;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case '%':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += putc('%', arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case 'c':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            c = va_arg(ap, int);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += putc(c, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case 'd':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            if (lflag == 0) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ui = (u_int)va_arg(ap, int);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                if (ui < (int)ui) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                    ui = -ui;
199767f8919635c4928607450d9e0abb932109ceToomas Soome                    ret += putc('-', arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                }
199767f8919635c4928607450d9e0abb932109ceToomas Soome                s = __uitoa(nbuf, ui, 10);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            } else {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ul = (u_long)va_arg(ap, long);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                if (ul < (long)ul) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                    ul = -ul;
199767f8919635c4928607450d9e0abb932109ceToomas Soome                    ret += putc('-', arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                }
199767f8919635c4928607450d9e0abb932109ceToomas Soome                s = __ultoa(nbuf, ul, 10);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            }
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += __puts(s, putc, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case 'l':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            lflag = 1;
199767f8919635c4928607450d9e0abb932109ceToomas Soome            goto reswitch;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case 'o':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            if (lflag == 0) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ui = (u_int)va_arg(ap, u_int);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                s = __uitoa(nbuf, ui, 8);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            } else {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ul = (u_long)va_arg(ap, u_long);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                s = __ultoa(nbuf, ul, 8);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            }
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += __puts(s, putc, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case 'p':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ul = (u_long)va_arg(ap, void *);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            s = __ultoa(nbuf, ul, 16);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += __puts("0x", putc, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += __puts(s, putc, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case 's':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            s = va_arg(ap, char *);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += __puts(s, putc, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case 'u':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            if (lflag == 0) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ui = va_arg(ap, u_int);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                s = __uitoa(nbuf, ui, 10);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            } else {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ul = va_arg(ap, u_long);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                s = __ultoa(nbuf, ul, 10);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            }
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += __puts(s, putc, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case 'x':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            if (lflag == 0) {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ui = va_arg(ap, u_int);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                s = __uitoa(nbuf, ui, 16);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            } else {
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ul = va_arg(ap, u_long);
199767f8919635c4928607450d9e0abb932109ceToomas Soome                s = __ultoa(nbuf, ul, 16);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            }
199767f8919635c4928607450d9e0abb932109ceToomas Soome            if (sflag)
199767f8919635c4928607450d9e0abb932109ceToomas Soome                ret += __puts("0x", putc, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            ret += __puts(s, putc, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case '0': case '1': case '2': case '3': case '4':
199767f8919635c4928607450d9e0abb932109ceToomas Soome        case '5': case '6': case '7': case '8': case '9':
199767f8919635c4928607450d9e0abb932109ceToomas Soome            pad = pad * 10 + c - '0';
199767f8919635c4928607450d9e0abb932109ceToomas Soome            goto reswitch;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        default:
199767f8919635c4928607450d9e0abb932109ceToomas Soome            break;
199767f8919635c4928607450d9e0abb932109ceToomas Soome        }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    }
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (ret);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soome__sputc(char c, void *arg)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    struct sp_data *sp;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    sp = arg;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    if (sp->sp_len < sp->sp_size)
199767f8919635c4928607450d9e0abb932109ceToomas Soome        sp->sp_buf[sp->sp_len++] = c;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    sp->sp_buf[sp->sp_len] = '\0';
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (1);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic int
199767f8919635c4928607450d9e0abb932109ceToomas Soome__puts(const char *s, putc_func_t *putc, void *arg)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    const char *p;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    int ret;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    ret = 0;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    for (p = s; *p != '\0'; p++)
199767f8919635c4928607450d9e0abb932109ceToomas Soome        ret += putc(*p, arg);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (ret);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic char *
199767f8919635c4928607450d9e0abb932109ceToomas Soome__uitoa(char *buf, u_int ui, int base)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *p;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    p = buf;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    *p = '\0';
199767f8919635c4928607450d9e0abb932109ceToomas Soome    do
199767f8919635c4928607450d9e0abb932109ceToomas Soome        *--p = digits[ui % base];
199767f8919635c4928607450d9e0abb932109ceToomas Soome    while ((ui /= base) != 0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (p);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soomestatic char *
199767f8919635c4928607450d9e0abb932109ceToomas Soome__ultoa(char *buf, u_long ul, int base)
199767f8919635c4928607450d9e0abb932109ceToomas Soome{
199767f8919635c4928607450d9e0abb932109ceToomas Soome    char *p;
199767f8919635c4928607450d9e0abb932109ceToomas Soome
199767f8919635c4928607450d9e0abb932109ceToomas Soome    p = buf;
199767f8919635c4928607450d9e0abb932109ceToomas Soome    *p = '\0';
199767f8919635c4928607450d9e0abb932109ceToomas Soome    do
199767f8919635c4928607450d9e0abb932109ceToomas Soome        *--p = digits[ul % base];
199767f8919635c4928607450d9e0abb932109ceToomas Soome    while ((ul /= base) != 0);
199767f8919635c4928607450d9e0abb932109ceToomas Soome    return (p);
199767f8919635c4928607450d9e0abb932109ceToomas Soome}