kolibrios/contrib/sdk/sources/newlib/libc/sys/gettod.c

#include <_ansi.h>
#include <reent.h>
#include <errno.h>
#include <time.h>
#include <sys/types.h>
#include <sys/time.h>

#define BCD_TO_BIN(val) ((val)=((val)&15) + ((val)>>4)*10)

int
_DEFUN (gettimeofday, (ptimeval, ptimezone),
     struct timeval *ptimeval _AND
     void *ptimezone)
{
    unsigned int xtmp;
    struct   tm tmblk;

    if( ptimeval )
    {
        ptimeval->tv_usec = 0;

         __asm__ __volatile__("int $0x40":"=a"(xtmp):"0"(3));
        tmblk.tm_sec = (xtmp>>16)&0xff;
        tmblk.tm_min = (xtmp>>8)&0xff;
        tmblk.tm_hour = xtmp&0xff;
        BCD_TO_BIN(tmblk.tm_sec);
        BCD_TO_BIN(tmblk.tm_min);
        BCD_TO_BIN(tmblk.tm_hour);
        __asm__ __volatile__("int $0x40":"=a"(xtmp):"0"(29));

        int bcd_day =  (xtmp >> 16);
        int bcd_mon =  ((xtmp & 0xFF00) >> 8);
        int bcd_year = (xtmp & 0xFF);

        tmblk.tm_mday = ((bcd_day & 0xF0)>>4)*10 + (bcd_day & 0x0F);
        tmblk.tm_mon = ((bcd_mon & 0xF0)>>4)*10 + (bcd_mon & 0x0F) - 1;
        tmblk.tm_year = ((bcd_year & 0xF0)>>4)*10 + (bcd_year & 0x0F) + 100;

        tmblk.tm_wday = tmblk.tm_yday = tmblk.tm_isdst = -1;
        ptimeval->tv_sec = mktime(&tmblk);
        return 0;
    }
    else
    {
        errno = EINVAL;
        return -1;
    };

}