vaseboot/VasEBoot-core/lib/cmos_datetime.c

/* kern/cmos_datetime.c - CMOS datetime function.
 *
 *  VAS_EBOOT  --  GRand Unified Bootloader
 *  Copyright (C) 2008,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/datetime.h>
#include <VasEBoot/cmos.h>
#include <VasEBoot/dl.h>

VAS_EBOOT_MOD_LICENSE ("GPLv3+");

#if !defined (__powerpc__) && !defined (__sparc__)
#define VasEBoot_get_datetime_cmos VasEBoot_get_datetime
#define VasEBoot_set_datetime_cmos VasEBoot_set_datetime
#endif

VasEBoot_err_t
VasEBoot_get_datetime_cmos (struct VasEBoot_datetime *datetime)
{
  int is_bcd, is_12hour;
  VasEBoot_uint8_t value, flag;
  VasEBoot_err_t err;

  err = VasEBoot_cmos_read (VAS_EBOOT_CMOS_INDEX_STATUS_B, &flag);
  if (err)
    return err;

  is_bcd = ! (flag & VAS_EBOOT_CMOS_STATUS_B_BINARY);

  err = VasEBoot_cmos_read (VAS_EBOOT_CMOS_INDEX_YEAR, &value);
  if (err)
    return err;
  if (is_bcd)
    value = VasEBoot_bcd_to_num (value);

  datetime->year = value;
  datetime->year += (value < 80) ? 2000 : 1900;

  err = VasEBoot_cmos_read (VAS_EBOOT_CMOS_INDEX_MONTH, &value);
  if (err)
    return err;
  if (is_bcd)
    value = VasEBoot_bcd_to_num (value);

  datetime->month = value;

  err = VasEBoot_cmos_read (VAS_EBOOT_CMOS_INDEX_DAY_OF_MONTH, &value);
  if (err)
    return err;
  if (is_bcd)
    value = VasEBoot_bcd_to_num (value);

  datetime->day = value;

  is_12hour = ! (flag & VAS_EBOOT_CMOS_STATUS_B_24HOUR);

  err = VasEBoot_cmos_read (VAS_EBOOT_CMOS_INDEX_HOUR, &value);
  if (err)
    return err;
  if (is_12hour)
    {
      is_12hour = (value & 0x80);

      value &= 0x7F;
      value--;
    }

  if (is_bcd)
    value = VasEBoot_bcd_to_num (value);

  if (is_12hour)
    value += 12;

  datetime->hour = value;

  err = VasEBoot_cmos_read (VAS_EBOOT_CMOS_INDEX_MINUTE, &value);
  if (err)
    return err;

  if (is_bcd)
    value = VasEBoot_bcd_to_num (value);

  datetime->minute = value;

  err = VasEBoot_cmos_read (VAS_EBOOT_CMOS_INDEX_SECOND, &value);
  if (err)
    return err;
  if (is_bcd)
    value = VasEBoot_bcd_to_num (value);

  datetime->second = value;

  return 0;
}

VasEBoot_err_t
VasEBoot_set_datetime_cmos (struct VasEBoot_datetime *datetime)
{
  int is_bcd, is_12hour;
  VasEBoot_uint8_t value, flag;
  VasEBoot_err_t err;

  err = VasEBoot_cmos_read (VAS_EBOOT_CMOS_INDEX_STATUS_B, &flag);
  if (err)
    return err;

  is_bcd = ! (flag & VAS_EBOOT_CMOS_STATUS_B_BINARY);

  value = ((datetime->year >= 2000) ? datetime->year - 2000 :
           datetime->year - 1900);

  if (is_bcd)
    value = VasEBoot_num_to_bcd (value);

  err = VasEBoot_cmos_write (VAS_EBOOT_CMOS_INDEX_YEAR, value);
  if (err)
    return err;

  value = datetime->month;

  if (is_bcd)
    value = VasEBoot_num_to_bcd (value);

  err = VasEBoot_cmos_write (VAS_EBOOT_CMOS_INDEX_MONTH, value);
  if (err)
    return err;

  value = datetime->day;

  if (is_bcd)
    value = VasEBoot_num_to_bcd (value);

  err = VasEBoot_cmos_write (VAS_EBOOT_CMOS_INDEX_DAY_OF_MONTH, value);
  if (err)
    return err;

  value = datetime->hour;

  is_12hour = (! (flag & VAS_EBOOT_CMOS_STATUS_B_24HOUR));

  if (is_12hour)
    {
      value++;

      if (value > 12)
        value -= 12;
      else
        is_12hour = 0;
    }

  if (is_bcd)
    value = VasEBoot_num_to_bcd (value);

  if (is_12hour)
    value |= 0x80;

  err = VasEBoot_cmos_write (VAS_EBOOT_CMOS_INDEX_HOUR, value);
  if (err)
    return err;

  value = datetime->minute;

  if (is_bcd)
    value = VasEBoot_num_to_bcd (value);

  err = VasEBoot_cmos_write (VAS_EBOOT_CMOS_INDEX_MINUTE, value);
  if (err)
    return err;

  value = datetime->second;

  if (is_bcd)
    value = VasEBoot_num_to_bcd (value);

  err = VasEBoot_cmos_write (VAS_EBOOT_CMOS_INDEX_SECOND, value);
  if (err)
    return err;

  return 0;
}