/*      $NetBSD: methods.c,v 1.8 2018/01/23 21:06:25 sevan Exp $        */

/*-
* Copyright (c) 1999 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Minoura Makoto.
*
* 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 <stdio.h>
#include <string.h>
#include <err.h>
#include <sys/types.h>

#include "memswitch.h"
#include "methods.h"

int
atoi_(const char **p)
{
       const char *p1 = *p;
       int v = 0;
       int first = 1;

       while (*p1 == ' ' || *p1 == '\t')
               p1++;

       if (*p1 == 0) {
               *p = 0;
               return 0;
       }
       if (strlen(p1) >= 2 && strncasecmp("0x", p1, 2) == 0) {
               p1 += 2;
               while (1) {
                       if (*p1 >= '0' && *p1 <= '9') {
                               v *= 16;
                               v += *p1 - '0';
                               first = 0;
                       } else if (*p1 >= 'A' && *p1 <= 'F') {
                               v *= 16;
                               v += *p1 - 'A' + 10;
                               first = 0;
                       } else if (*p1 >= 'a' && *p1 <= 'f') {
                               v *= 16;
                               v += *p1 - 'a' + 10;
                               first = 0;
                       } else {
                               break;
                       }
                       p1++;
               }
       } else {
               while (1) {
                       if (*p1 >= '0' && *p1 <= '9') {
                               v *= 10;
                               v += *p1 - '0';
                               first = 0;
                       } else {
                               break;
                       }
                       p1++;
               }
       }

       if (first) {
               *p = 0;
               return 0;
       }

       while (*p1 == ' ' || *p1 == '\t') p1++;
       *p = p1;
       return v;
}

int
fill_uchar(struct property *prop)
{
       if (current_values == 0)
               alloc_current_values();

       prop->current_value.byte[0] = current_values[prop->offset];
       prop->current_value.byte[1] = 0;
       prop->current_value.byte[2] = 0;
       prop->current_value.byte[3] = 0;
       prop->value_valid = 1;

       return 0;
}

int
fill_ushort(struct property *prop)
{
       if (current_values == 0)
               alloc_current_values();

       prop->current_value.byte[0] = current_values[prop->offset];
       prop->current_value.byte[1] = current_values[prop->offset+1];
       prop->current_value.byte[2] = 0;
       prop->current_value.byte[3] = 0;
       prop->value_valid = 1;

       return 0;
}

int
fill_ulong(struct property *prop)
{
       if (current_values == 0)
               alloc_current_values();

       prop->current_value.byte[0] = current_values[prop->offset];
       prop->current_value.byte[1] = current_values[prop->offset+1];
       prop->current_value.byte[2] = current_values[prop->offset+2];
       prop->current_value.byte[3] = current_values[prop->offset+3];
       prop->value_valid = 1;

       return 0;
}

int
flush_uchar(struct property *prop)
{
       if (!prop->modified)
               return 0;

       if (modified_values == 0)
               alloc_modified_values();

       modified_values[prop->offset] = prop->modified_value.byte[0];

       return 0;
}

int
flush_ushort(struct property *prop)
{
       if (!prop->modified)
               return 0;

       if (modified_values == 0)
               alloc_modified_values();

       modified_values[prop->offset] = prop->modified_value.byte[0];
       modified_values[prop->offset+1] = prop->modified_value.byte[1];

       return 0;
}

int
flush_ulong(struct property *prop)
{
       if (!prop->modified)
               return 0;

       if (modified_values == 0)
               alloc_modified_values();

       modified_values[prop->offset] = prop->modified_value.byte[0];
       modified_values[prop->offset+1] = prop->modified_value.byte[1];
       modified_values[prop->offset+2] = prop->modified_value.byte[2];
       modified_values[prop->offset+3] = prop->modified_value.byte[3];

       return 0;
}

int
flush_dummy(struct property *prop)
{
       return 0;
}

int
parse_dummy(struct property *prop, const char *value)
{
       warnx("Cannot modify %s.%s", prop->class, prop->node);

       return -1;
}

int
parse_byte(struct property *prop, const char *value)
{
       const char *p = value;
       int v;

       v = atoi_(&p);
       if (p == 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       if (strcasecmp("MB", p) == 0)
               v *= 1024 * 1024;
       else if (strcasecmp("KB", p) == 0)
               v *= 1024;
       else if (*p != 0 &&
                strcasecmp("B", p) != 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       if (v < prop->min) {
               warnx("%s: Too small", value);
               return -1;
       } else if (v > prop->max) {
               warnx("%s: Too large", value);
               return -1;
       }

       prop->modified = 1;
       prop->modified_value.longword = v;

       return 0;
}

int
parse_uchar(struct property *prop, const char *value)
{
       const char *p = value;
       int v;

       v = atoi_(&p);
       if (p == 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       if (v < prop->min) {
               warnx("%s: Too small", value);
               return -1;
       } else if (v > prop->max) {
               warnx("%s: Too large", value);
               return -1;
       }

       prop->modified = 1;
       prop->modified_value.byte[0] = v;

       return 0;
}

int
parse_ulong(struct property *prop, const char *value)
{
       const char *p = value;
       int v;

       v = atoi_(&p);
       if (p == 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       if (v < prop->min) {
               warnx("%s: Too small", value);
               return -1;
       } else if (v > prop->max) {
               warnx("%s: Too large", value);
               return -1;
       }

       prop->modified = 1;
       prop->modified_value.longword = v;

       return 0;
}

int
parse_ushort(struct property *prop, const char *value)
{
       const char *p = value;
       int v;

       v = atoi_(&p);
       if (p == 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       if (v < prop->min) {
               warnx("%s: Too small", value);
               return -1;
       } else if (v > prop->max) {
               warnx("%s: Too large", value);
               return -1;
       }

       prop->modified = 1;
       prop->modified_value.word[0] = v;

       return 0;
}

int
parse_time(struct property *prop, const char *value)
{
       const char *p = value;
       int v;

       while (*p == ' ' || *p == '\t') p++;
       if (*p == '-') {
               p++;
               v = -atoi_(&p);
       } else
               v = atoi_(&p);
       if (p == 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       if (strcasecmp("hours", p) == 0 || strcasecmp("hour", p) == 0)
               v *= 60 * 60;
       else if (strcasecmp("minutes", p) == 0 ||
                strcasecmp("minute", p) == 0)
               v *= 60;
       else if (*p != 0 &&
                strcasecmp("second", p) != 0 &&
                strcasecmp("seconds", p) != 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       if (v < prop->min) {
               warnx("%s: Too small", value);
               return -1;
       } else if (v > prop->max) {
               warnx("%s: Too large", value);
               return -1;
       }

       prop->modified = 1;
       prop->modified_value.longword = v;

       return 0;
}

int
parse_bootdev(struct property *prop, const char *value)
{
       const char *p = value;
       int v;
       char expr_scsi[32];

       while (*p == ' ' || *p == '\t') p++;

       if (strcasecmp("STD", p) == 0)
               v = 0;
       else if (strcasecmp("ROM", p) == 0)
               v = 0xa000;
       else if (strcasecmp("RAM", p) == 0)
               v = 0xb000;
       else if (strncasecmp("HD", p, 2) == 0) {
               p += 2;
               v = atoi_(&p);
               if (p == 0 || v < 0 || v > 15) {
                       warnx("%s: Invalid value", value);
                       return -1;
               }
               v *= 0x0100;
               v += 0x8000;
       } else if (strncasecmp("FD", p, 2) == 0) {
               p += 2;
               v = atoi_(&p);
               if (p == 0 || v < 0 || v > 3) {
                       warnx("%s: Invalid value", value);
                       return -1;
               }
               v *= 0x0100;
               v += 0x9070;
       } else if (strncasecmp("INSCSI", p, 6) == 0 ||
                  strncasecmp("EXSCSI", p, 6) == 0) {
               int isin = strncasecmp("EXSCSI", p, 6);

               p += 6;
               v = atoi_(&p);
               if (p == 0 || v < 0 || v > 7) {
                       warnx("%s: Invalid value", value);
                       return -1;
               }

               /* change boot.romaddr */
               sprintf(expr_scsi, "boot.romaddr=0x%06x",
                       (isin ? 0xfc0000 : 0xea0020) + v * 4);
               modify_single(expr_scsi);

               /* boot.device again */
               v = 0xa000;
       } else {
               warnx("%s: Invalid value", value);
               return -1;
       }

       prop->modified = 1;
       prop->modified_value.word[0] = v;

       return 0;
}

int
parse_serial(struct property *prop, const char *value)
#define NEXTSPEC        while (*p == ' ' || *p == '\t') p++;            \
                       if (*p++ != ',') {                              \
                               warnx("%s: Invalid value", value);      \
                               return -1;                              \
                       }                                               \
                       while (*p == ' ' || *p == '\t') p++;
{
       const char *p = value;
       const char *q;
       int baud, bit, parity, stop, flow;
       static const int bauds[] = {75, 150, 300, 600, 1200, 2400, 4800, 9600,
           17361, 0};
       static const char parities[] = "noe";
       int i;

       while (*p == ' ' || *p == '\t') p++;

       /* speed */
       baud = atoi_(&p);
       if (p == 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }
       for (i = 0; bauds[i]; i++)
               if (baud == bauds[i])
                       break;
       if (bauds[i] == 0) {
               warnx("%d: Invalid speed", baud);
               return -1;
       }
       baud = i;

       NEXTSPEC;

       /* bit size */
       if (*p < '5' || *p > '8') {
               warnx("%c: Invalid bit size", *p);
               return -1;
       }
       bit = *p++ - '5';

       NEXTSPEC;

       /* parity */
       q = strchr(parities, *p++);
       if (q == 0) {
               warnx("%c: Invalid parity spec", *p);
               return -1;
       }
       parity = q - parities;

       NEXTSPEC;

       /* stop bit */
       if (strncmp(p, "1.5", 3) == 0) {
               stop = 2;
               p += 3;
       } else if (strncmp(p, "2", 1) == 0) {
               stop = 0;
               p++;
       } else if (strncmp(p, "1", 1) == 0) {
               stop = 1;
               p++;
       } else {
               warnx("%s: Invalid value", value);
               return -1;
       }

       NEXTSPEC;

       /* flow */
       if (*p == '-')
               flow = 0;
       else if (*p == 's')
               flow = 1;
       else {
               warnx("%s: Invalid value", value);
               return -1;
       }

       p++;
       while (*p == ' ' || *p == '\t') p++;
       if (*p != 0) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       prop->modified = 1;
       prop->modified_value.word[0] = ((stop << 14) +
                                       (parity << 12) +
                                       (bit << 10) +
                                       (flow << 9) +
                                       baud);

       return 0;
}
#undef NEXTSPEC

int
parse_srammode(struct property *prop, const char *value)
{
       static const char *const sramstrs[] = {"unused", "SRAMDISK", "program"};
       int i;

       for (i = 0; i <= 2; i++) {
               if (strcasecmp(value, sramstrs[i]) == 0)
                       break;
       }
       if (i > 2) {
               warnx("%s: Invalid value", value);
               return -1;
       }

       prop->modified = 1;
       prop->modified_value.byte[0] = i;

       return 0;
}

int
print_uchar(struct property *prop, char *str)
{
       if (prop->modified)
               snprintf(str, MAXVALUELEN,
                        "%d", prop->modified_value.byte[0]);
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               snprintf(str, MAXVALUELEN, "%d",
                        prop->current_value.byte[0]);
       }

       return 0;
}

int
print_ucharh(struct property *prop, char *str)
{
       if (prop->modified)
               snprintf(str, MAXVALUELEN,
                        "0x%4.4x", prop->modified_value.byte[0]);
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               snprintf(str, MAXVALUELEN,
                        "0x%4.4x", prop->current_value.byte[0]);
       }

       return 0;
}

int
print_ushorth(struct property *prop, char *str)
{
       if (prop->modified)
               snprintf(str, MAXVALUELEN,
                         "0x%4.4x", prop->modified_value.word[0]);
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               snprintf(str, MAXVALUELEN,
                        "0x%4.4x", prop->current_value.word[0]);
       }

       return 0;
}

int
print_ulong(struct property *prop, char *str)
{
       if (prop->modified)
               snprintf(str, MAXVALUELEN,
                        "%ld", prop->modified_value.longword);
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               snprintf(str, MAXVALUELEN,
                        "%ld", prop->current_value.longword);
       }

       return 0;
}

int
print_ulongh(struct property *prop, char *str)
{
       if (prop->modified)
               snprintf(str, MAXVALUELEN,
                        "0x%8.8lx", prop->modified_value.longword);
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               snprintf(str, MAXVALUELEN,
                        "0x%8.8lx", prop->current_value.longword);
       }

       return 0;
}

int
print_magic(struct property *prop, char *str)
{
       if (!prop->value_valid)
               prop->fill(prop);
       snprintf(str, MAXVALUELEN, "%c%c%c%c",
                prop->current_value.byte[0],
                prop->current_value.byte[1],
                prop->current_value.byte[2],
                prop->current_value.byte[3]);

       return 0;
}

int
print_timesec(struct property *prop, char *str)
{
       if (prop->modified)
               snprintf(str, MAXVALUELEN,
                        "%ld second", prop->modified_value.longword);
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               snprintf(str, MAXVALUELEN,
                        "%ld second", prop->current_value.longword);
       }

       return 0;
}

int
print_bootdev(struct property *prop, char *str)
{
       unsigned int v;

       if (prop->modified)
               v = prop->modified_value.word[0];
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               v = prop->current_value.word[0];
       }

       if (v == 0)
               strcpy(str, "STD");
       else if (v == 0xa000)
               strcpy(str, "ROM");
       else if (v == 0xb000)
               strcpy(str, "RAM");
       else if (v >= 0x8000 && v < 0x9000)
               snprintf(str, MAXVALUELEN, "HD%d", (v & 0x0f00) >> 8);
       else if (v >= 0x9000 && v < 0xa000)
               snprintf(str, MAXVALUELEN, "FD%d", (v & 0x0f00) >> 8);
       else
               snprintf(str, MAXVALUELEN, "%8.8x", v);

       return 0;
}

int
print_serial(struct property *prop, char *str)
{
       unsigned int v;
       const char *baud, *stop;
       char bit, parity, flow;
       static const char *const bauds[] = {"75", "150", "300", "600", "1200",
                              "2400", "4800", "9600", "17361"};
       static const char bits[] = "5678";
       static const char parities[] = "noen";
       static const char *const stops[] = {"2", "1", "1.5", "2"};
       static const char flows[] = "-s";

       if (prop->modified)
               v = prop->modified_value.word[0];
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               v = prop->current_value.word[0];
       }

       baud = bauds[v & 0x000f];
       bit = bits[(v & 0x0c00) >> 10];
       parity = parities[(v & 0x3000) >> 12];
       stop = stops[(v & 0xe000) >> 14];
       flow = flows[(v & 0x0200) >> 9];
       sprintf(str, "%s,%c,%c,%s,%c", baud, bit, parity, stop, flow);

       return 0;
}

int
print_srammode(struct property *prop, char *str)
{
       int v;
       static const char *const sramstrs[] = {"unused", "SRAMDISK", "program"};

       if (prop->modified)
               v = prop->modified_value.byte[0];
       else {
               if (!prop->value_valid)
                       prop->fill(prop);
               v = prop->current_value.byte[0];
       }

       if (v < 0 || v > 2)
               strcpy(str, "INVALID");
       else
               strcpy(str, sramstrs[v]);

       return 0;
}

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.