/*
 *  VasEBoot  --  GRand Unified Bootloader
 *  Copyright (C) 2009  Free Software Foundation, Inc.
 *
 *  VasEBoot 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.
 *
 *  VasEBoot 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 VasEBoot.  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>

VasEBoot_MOD_LICENSE ("GPLv3+");

static VasEBoot_err_t
parse_args (int argc, char *argv[], int *byte, int *bit)
{
  char *rest;

  if (argc != 1)
    return VasEBoot_error (VasEBoot_ERR_BAD_ARGUMENT, "address required");

  *byte = VasEBoot_strtoul (argv[0], &rest, 0);
  if (*rest != ':')
    return VasEBoot_error (VasEBoot_ERR_BAD_ARGUMENT, "address required");

  *bit = VasEBoot_strtoul (rest + 1, 0, 0);

  return VasEBoot_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 VasEBoot_ERR_NONE;

  return VasEBoot_error (VasEBoot_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;


VasEBoot_MOD_INIT(cmostest)
{
  cmd = VasEBoot_register_command ("cmostest", VasEBoot_cmd_cmostest,
			       N_("BYTE:BIT"),
			       N_("Test bit at BYTE:BIT in CMOS."));
  cmd_clean = VasEBoot_register_command ("cmosclean", VasEBoot_cmd_cmosclean,
				     N_("BYTE:BIT"),
				     N_("Clear bit at BYTE:BIT in CMOS."));
  cmd_set = VasEBoot_register_command ("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."));
}

VasEBoot_MOD_FINI(cmostest)
{
  VasEBoot_unregister_command (cmd);
  VasEBoot_unregister_command (cmd_clean);
  VasEBoot_unregister_command (cmd_set);
}