arch/all-pc/battclock/readbattclock.c

   1 /*
   2     Copyright © 1995-2011, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: ReadBattClock() function.
   6     Lang: english
   7 */
   8
   9 #include <proto/exec.h>
  10 #include <proto/utility.h>
  11 #include <utility/date.h>
  12
  13 #include "battclock_intern.h"
  14 #include "cmos.h"
  15
  16 static inline int bcd_to_dec(int x)
  17 {
  18     return ( (x >> 4) * 10 + (x & 0x0f) );
  19 }
  20
  21 AROS_LH0(ULONG, ReadBattClock,
  22          struct BattClockBase *, BattClockBase, 2, Battclock)
  23 {
  24     AROS_LIBFUNC_INIT
  25
  26     struct ClockData date;
  27     UWORD century;
  28     UWORD status_b;
  29     ULONG secs;
  30
  31     ObtainSemaphore(&BattClockBase->sem);
  32
  33     /* Make sure time isn't currently being updated */
  34     while ((ReadCMOSByte(STATUS_A) & 0x80) != 0);
  35
  36     date.sec   = ReadCMOSByte(SEC);
  37     date.min   = ReadCMOSByte(MIN);
  38     date.hour  = ReadCMOSByte(HOUR);
  39     date.mday  = ReadCMOSByte(MDAY);
  40     date.month = ReadCMOSByte(MONTH);
  41     date.year  = ReadCMOSByte(YEAR);
  42     century    = ReadCMOSByte(BattClockBase->century);
  43     status_b   = ReadCMOSByte(STATUS_B);
  44
  45     ReleaseSemaphore(&BattClockBase->sem);
  46
  47     if ((status_b & 0x04) == 0)
  48     {
  49         date.sec   = bcd_to_dec(date.sec);
  50         date.min   = bcd_to_dec(date.min);
  51         date.hour  = bcd_to_dec(date.hour);
  52         date.mday  = bcd_to_dec(date.mday);
  53         date.month = bcd_to_dec(date.month);
  54         date.year  = bcd_to_dec(date.year);
  55         century    = bcd_to_dec(century);
  56     }
  57
  58     date.year = century * 100 + date.year;
  59
  60     secs=Date2Amiga(&date);
  61
  62     return secs;
  63
  64     AROS_LIBFUNC_EXIT
  65 } /* ReadBattClock */