/*      $NetBSD: ofhandlers.c,v 1.6 2013/07/02 11:59:46 joerg Exp $     */

/*-
 * Copyright (c) 1996 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by Jason R. Thorpe.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/types.h>
#include <sys/ioctl.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#include <stdio.h>
#include <string.h>
#include <unistd.h>

#include <dev/ofw/openfirmio.h>

#include "defs.h"

extern  char *path_openfirm;
extern  int eval;
extern  int verbose;

static  char err_str[BUFSIZE];

static  void of_notsupp(const struct extabent *, struct ofiocdesc *, char *);
static  void of_uint32h(const struct extabent *, struct ofiocdesc *, char *);
static  void of_uint32d(const struct extabent *, struct ofiocdesc *, char *);

/*
 * There are several known fields that I either don't know how to
 * deal with or require special treatment.
 */
static  const struct extabent ofextab[] = {
        { "security-password",          of_notsupp },
        { "security-mode",              of_notsupp },
        { "oem-logo",                   of_notsupp },
        { "oem-banner",                 of_notsupp },
        { "real-base",                  of_uint32h },
        { "real-size",                  of_uint32h },
        { "load-base",                  of_uint32h },
        { "virt-base",                  of_uint32h },
        { "virt-size",                  of_uint32h },
        { "screen-#columns",            of_uint32d },
        { "screen-#rows",               of_uint32d },
        { "selftest-#megs",             of_uint32d },
        { NULL,                         of_notsupp },
};

#define BARF(str1, str2) {                                              \
        snprintf(err_str, sizeof err_str, "%s: %s", (str1), (str2));    \
        ++eval;                                                         \
        return (err_str);                                               \
};

void
of_action(char *keyword, char *arg)
{
        char    *cp;

        if ((cp = of_handler(keyword, arg)) != NULL)
                warnx("%s", cp);
        return;
}

char *
of_handler(char *keyword, char *arg)
{
        struct ofiocdesc ofio;
        const struct extabent *ex;
        char ofio_buf[BUFSIZE];
        int fd, optnode;

        if ((fd = open(path_openfirm, arg ? O_RDWR : O_RDONLY, 0640)) < 0)
                BARF(path_openfirm, strerror(errno));

        /* Check to see if it's a special-case keyword. */
        for (ex = ofextab; ex->ex_keyword != NULL; ++ex)
                if (strcmp(ex->ex_keyword, keyword) == 0)
                        break;

        if (ioctl(fd, OFIOCGETOPTNODE, (char *)&optnode) < 0) {
                (void)close(fd);
                BARF("OFIOCGETOPTNODE", strerror(errno));
        }

        memset(&ofio_buf[0], 0, sizeof(ofio_buf));
        memset(&ofio, 0, sizeof(ofio));
        ofio.of_nodeid = optnode;
        ofio.of_name = keyword;
        ofio.of_namelen = strlen(ofio.of_name);

        if (arg) {
                if (verbose) {
                        printf("old: ");

                        ofio.of_buf = &ofio_buf[0];
                        ofio.of_buflen = sizeof(ofio_buf);
                        if (ioctl(fd, OFIOCGET, (char *)&ofio) < 0) {
                                (void)close(fd);
                                BARF("OFIOCGET", strerror(errno));
                        }

                        if (ofio.of_buflen <= 0) {
                                printf("nothing available for %s\n", keyword);
                                goto out;
                        }

                        if (ex->ex_keyword != NULL)
                                (*ex->ex_handler)(ex, &ofio, NULL);
                        else
                                printf("%s\n", ofio.of_buf);
                }
 out:
                if (ex->ex_keyword != NULL)
                        (*ex->ex_handler)(ex, &ofio, arg);
                else {
                        ofio.of_buf = arg;
                        ofio.of_buflen = strlen(arg);
                }

                if (ioctl(fd, OFIOCSET, (char *)&ofio) < 0) {
                        (void)close(fd);
                        BARF("invalid keyword", keyword);
                }

                if (verbose) {
                        printf("new: ");
                        if (ex->ex_keyword != NULL)
                                (*ex->ex_handler)(ex, &ofio, NULL);
                        else
                                printf("%s\n", ofio.of_buf);
                }
        } else {
                ofio.of_buf = &ofio_buf[0];
                ofio.of_buflen = sizeof(ofio_buf);
                if (ioctl(fd, OFIOCGET, (char *)&ofio) < 0) {
                        (void)close(fd);
                        BARF("OFIOCGET", strerror(errno));
                }

                if (ofio.of_buflen <= 0) {
                        (void)snprintf(err_str, sizeof err_str,
                            "nothing available for %s", keyword);
                        return (err_str);
                }

                if (ex->ex_keyword != NULL)
                        (*ex->ex_handler)(ex, &ofio, NULL);
                else
                        printf("%s=%s\n", keyword, ofio.of_buf);
        }

        (void)close(fd);
        return (NULL);
}

/* ARGSUSED */
static void
of_notsupp(const struct extabent *exent, struct ofiocdesc *ofiop, char *arg)
{

        warnx("property `%s' not yet supported", exent->ex_keyword);
}

static void
of_uint32h(const struct extabent *exent, struct ofiocdesc *ofiop, char *arg)
{

        printf("%s=0x%08x\n", exent->ex_keyword, *(uint32_t *)ofiop->of_buf);
}

static void
of_uint32d(const struct extabent *exent, struct ofiocdesc *ofiop, char *arg)
{

        printf("%s=%d\n", exent->ex_keyword, *(uint32_t *)ofiop->of_buf);
}

/*
 * XXX: This code is quite ugly.  You have been warned.
 * (Really!  This is the only way I could get it to work!)
 */
void
of_dump(void)
{
        struct ofiocdesc ofio1, ofio2;
        const struct extabent *ex;
        char buf1[BUFSIZE], buf2[BUFSIZE], buf3[BUFSIZE], buf4[BUFSIZE];
        int fd, optnode;

        if ((fd = open(path_openfirm, O_RDONLY, 0640)) < 0)
                err(1, "open: %s", path_openfirm);

        if (ioctl(fd, OFIOCGETOPTNODE, (char *)&optnode) < 0)
                err(1, "OFIOCGETOPTNODE");

        memset(&ofio1, 0, sizeof(ofio1));

        /* This will grab the first property name from OPIOCNEXTPROP. */
        memset(buf1, 0, sizeof(buf1));
        memset(buf2, 0, sizeof(buf2));

        ofio1.of_nodeid = ofio2.of_nodeid = optnode;

        ofio1.of_name = buf1;
        ofio1.of_buf = buf2;

        ofio2.of_name = buf3;
        ofio2.of_buf = buf4;

        /*
         * For reference: ofio1 is for obtaining the name.  Pass the
         * name of the last property read in of_name, and the next one
         * will be returned in of_buf.  To get the first name, pass
         * an empty string.  There are no more properties when an
         * empty string is returned.
         *
         * ofio2 is for obtaining the value associated with that name.
         * For some crazy reason, it seems as if we need to do all
         * of that gratuitious zapping and copying.  *sigh*
         */
        for (;;) {
                ofio1.of_namelen = strlen(ofio1.of_name);
                ofio1.of_buflen = sizeof(buf2);

                if (ioctl(fd, OFIOCNEXTPROP, (char *)&ofio1) < 0) {
                        close(fd);
                        return;
                        /* err(1, "ioctl: OFIOCNEXTPROP"); */
                }

                /*
                 * The name of the property we wish to get the
                 * value for has been stored in the value field
                 * of ofio1.  If the length of the name is 0, there
                 * are no more properties left.
                 */
                strcpy(ofio2.of_name, ofio1.of_buf);    /* XXX strcpy is safe */
                ofio2.of_namelen = strlen(ofio2.of_name);

                if (ofio2.of_namelen == 0) {
                        (void)close(fd);
                        return;
                }

                memset(ofio2.of_buf, 0, sizeof(buf4));
                ofio2.of_buflen = sizeof(buf4);

                if (ioctl(fd, OFIOCGET, (char *)&ofio2) < 0)
                        err(1, "ioctl: OFIOCGET");

                for (ex = ofextab; ex->ex_keyword != NULL; ++ex)
                        if (strcmp(ex->ex_keyword, ofio2.of_name) == 0)
                                break;

                if (ex->ex_keyword != NULL)
                        (*ex->ex_handler)(ex, &ofio2, NULL);
                else
                        printf("%s=%s\n", ofio2.of_name, ofio2.of_buf);

                /*
                 * Place the name of the last read value back into
                 * ofio1 so that we may obtain the next name.
                 */
                memset(ofio1.of_name, 0, sizeof(buf1));
                memset(ofio1.of_buf, 0, sizeof(buf2));
                strcpy(ofio1.of_name, ofio2.of_name);   /* XXX strcpy is safe */
        }
        /* NOTREACHED */
}