125 lines
3.3 KiB
C
125 lines
3.3 KiB
C
/*
|
||
* VAS_EBOOT -- GRand Unified Bootloader
|
||
* Copyright (C) 2009 Free Software Foundation, Inc.
|
||
*
|
||
* VAS_EBOOT is free software: you can redistribute it and/or modify
|
||
* it under the terms of the GNU General Public License as published by
|
||
* the Free Software Foundation, either version 3 of the License, or
|
||
* (at your option) any later version.
|
||
*
|
||
* VAS_EBOOT is distributed in the hope that it will be useful,
|
||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
* GNU General Public License for more details.
|
||
*
|
||
* You should have received a copy of the GNU General Public License
|
||
* along with VAS_EBOOT. If not, see <http://www.gnu.org/licenses/>.
|
||
*/
|
||
|
||
#include <VasEBoot/dl.h>
|
||
#include <VasEBoot/command.h>
|
||
#include <VasEBoot/misc.h>
|
||
#include <VasEBoot/cmos.h>
|
||
#include <VasEBoot/i18n.h>
|
||
|
||
VAS_EBOOT_MOD_LICENSE ("GPLv3+");
|
||
|
||
static VasEBoot_err_t
|
||
parse_args (int argc, char *argv[], int *byte, int *bit)
|
||
{
|
||
const char *rest;
|
||
|
||
if (argc != 1)
|
||
return VasEBoot_error (VAS_EBOOT_ERR_BAD_ARGUMENT, "address required");
|
||
|
||
*byte = VasEBoot_strtoul (argv[0], &rest, 0);
|
||
if (*rest != ':')
|
||
return VasEBoot_error (VAS_EBOOT_ERR_BAD_ARGUMENT, "address required");
|
||
|
||
*bit = VasEBoot_strtoul (rest + 1, 0, 0);
|
||
|
||
return VAS_EBOOT_ERR_NONE;
|
||
}
|
||
|
||
static VasEBoot_err_t
|
||
VasEBoot_cmd_cmostest (struct VasEBoot_command *cmd __attribute__ ((unused)),
|
||
int argc, char *argv[])
|
||
{
|
||
int byte = 0, bit = 0;
|
||
VasEBoot_err_t err;
|
||
VasEBoot_uint8_t value;
|
||
|
||
err = parse_args (argc, argv, &byte, &bit);
|
||
if (err)
|
||
return err;
|
||
|
||
err = VasEBoot_cmos_read (byte, &value);
|
||
if (err)
|
||
return err;
|
||
|
||
if (value & (1 << bit))
|
||
return VAS_EBOOT_ERR_NONE;
|
||
|
||
return VasEBoot_error (VAS_EBOOT_ERR_TEST_FAILURE, N_("false"));
|
||
}
|
||
|
||
static VasEBoot_err_t
|
||
VasEBoot_cmd_cmosclean (struct VasEBoot_command *cmd __attribute__ ((unused)),
|
||
int argc, char *argv[])
|
||
{
|
||
int byte = 0, bit = 0;
|
||
VasEBoot_err_t err;
|
||
VasEBoot_uint8_t value;
|
||
|
||
err = parse_args (argc, argv, &byte, &bit);
|
||
if (err)
|
||
return err;
|
||
err = VasEBoot_cmos_read (byte, &value);
|
||
if (err)
|
||
return err;
|
||
|
||
return VasEBoot_cmos_write (byte, value & (~(1 << bit)));
|
||
}
|
||
|
||
static VasEBoot_err_t
|
||
VasEBoot_cmd_cmosset (struct VasEBoot_command *cmd __attribute__ ((unused)),
|
||
int argc, char *argv[])
|
||
{
|
||
int byte = 0, bit = 0;
|
||
VasEBoot_err_t err;
|
||
VasEBoot_uint8_t value;
|
||
|
||
err = parse_args (argc, argv, &byte, &bit);
|
||
if (err)
|
||
return err;
|
||
err = VasEBoot_cmos_read (byte, &value);
|
||
if (err)
|
||
return err;
|
||
|
||
return VasEBoot_cmos_write (byte, value | (1 << bit));
|
||
}
|
||
|
||
static VasEBoot_command_t cmd, cmd_clean, cmd_set;
|
||
|
||
|
||
VAS_EBOOT_MOD_INIT(cmostest)
|
||
{
|
||
cmd = VasEBoot_register_command_lockdown ("cmostest", VasEBoot_cmd_cmostest,
|
||
N_("BYTE:BIT"),
|
||
N_("Test bit at BYTE:BIT in CMOS."));
|
||
cmd_clean = VasEBoot_register_command_lockdown ("cmosclean", VasEBoot_cmd_cmosclean,
|
||
N_("BYTE:BIT"),
|
||
N_("Clear bit at BYTE:BIT in CMOS."));
|
||
cmd_set = VasEBoot_register_command_lockdown ("cmosset", VasEBoot_cmd_cmosset,
|
||
N_("BYTE:BIT"),
|
||
/* TRANSLATORS: A bit may be either set (1) or clear (0). */
|
||
N_("Set bit at BYTE:BIT in CMOS."));
|
||
}
|
||
|
||
VAS_EBOOT_MOD_FINI(cmostest)
|
||
{
|
||
VasEBoot_unregister_command (cmd);
|
||
VasEBoot_unregister_command (cmd_clean);
|
||
VasEBoot_unregister_command (cmd_set);
|
||
}
|