/*      $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 */
}

You are viewing proxied material from ftp.icm.edu.pl. The copyright of proxied material belongs to its original authors. Any comments or complaints in relation to proxied material should be directed to the original authors of the content concerned. Please see the disclaimer for more details.