Subversion Repositories openrisc_me

/*

 *  Real Time Clock Driver Wrapper for Libchip

 *

 *  The license and distribution terms for this file may be

 *  found in the file LICENSE in this distribution or at

 *  http://www.OARcorp.com/rtems/license.html.

 *

 *  $Id: tod.c,v 1.2 2001-09-27 12:01:12 chris Exp $

 */

#include <rtems.h>

#include <libchip/rtc.h>

/*

 *  Configuration Information

 */

extern unsigned long              RTC_Count;

extern rtems_device_minor_number  RTC_Minor;

int RTC_Present;

/*

 *  rtc_initialize

 *

 *  Initialize the RTC driver

 */

rtems_device_driver rtc_initialize(

  rtems_device_major_number  major,

  rtems_device_minor_number  minor_arg,

  void                      *arg

)

{

  rtems_device_minor_number  minor;

  rtems_status_code          status;

  for (minor=0; minor < RTC_Count ; minor++) {

    /*

     * First perform the configuration dependent probe, then the

     * device dependent probe

     */

    if (RTC_Table[minor].deviceProbe && RTC_Table[minor].deviceProbe(minor)) {

      /*

       * Use this device as the primary RTC

       */

      RTC_Minor = minor;

      RTC_Present = 1;

      break;

    }

  }

  if ( !RTC_Present ) {

    /*

     * Failed to find an RTC -- this is not a fatal error.

     */

    return RTEMS_INVALID_NUMBER;

  }

  /*

   *  Register and initialize the primary RTC's

   */

  status = rtems_io_register_name( "/dev/rtc", major, RTC_Minor );

  if (status != RTEMS_SUCCESSFUL) {

    rtems_fatal_error_occurred(status);

  }

  RTC_Table[minor].pDeviceFns->deviceInitialize( RTC_Minor );

  /*

   *  Now initialize any secondary RTC's

   */

  for ( minor++ ; minor<RTC_Count ; minor++) {

    /*

     * First perform the configuration dependent probe, then the

     * device dependent probe

     */

    if (RTC_Table[minor].deviceProbe && RTC_Table[minor].deviceProbe(minor)) {

      status = rtems_io_register_name(

        RTC_Table[minor].sDeviceName,

        major,

        minor );

      if (status != RTEMS_SUCCESSFUL) {

        rtems_fatal_error_occurred(status);

      }

      /*

       * Initialize the hardware device.

       */

      RTC_Table[minor].pDeviceFns->deviceInitialize(minor);

    }

  }

  return RTEMS_SUCCESSFUL;

}

/*PAGE

 *

 *  This routine copies the time from the real time clock to RTEMS

 *

 *  Input parameters:  NONE

 *

 *  Output parameters:  NONE

 *

 *  Return values: NONE

 */

void setRealTimeToRTEMS()

{

  rtems_time_of_day rtc_tod;

  if (!RTC_Present)

    return;

  RTC_Table[RTC_Minor].pDeviceFns->deviceGetTime(RTC_Minor, &rtc_tod);

  rtems_clock_set( &rtc_tod );

}

/*PAGE

 *

 *  setRealTimeFromRTEMS

 *

 *  This routine copies the time from RTEMS to the real time clock

 *

 *  Input parameters:  NONE

 *

 *  Output parameters:  NONE

 *

 *  Return values: NONE

 */

void setRealTimeFromRTEMS()

{

  rtems_time_of_day rtems_tod;

  if (!RTC_Present)

    return;

  rtems_clock_get( RTEMS_CLOCK_GET_TOD, &rtems_tod );

  RTC_Table[RTC_Minor].pDeviceFns->deviceSetTime(RTC_Minor, &rtems_tod);

}

/*PAGE

 *

 *  getRealTime

 *

 *  This routine reads the current time from the RTC.

 *

 *  Input parameters:  NONE

 *

 *  Output parameters:  NONE

 *

 *  Return values: NONE

 */

void getRealTime(

  rtems_time_of_day *tod

)

{

  if (!RTC_Present)

    return;

  RTC_Table[RTC_Minor].pDeviceFns->deviceGetTime(RTC_Minor, tod);

}

/*PAGE

 *

 *  setRealTime

 *

 *  This routine sets the RTC.

 *

 *  Input parameters:  NONE

 *

 *  Output parameters:  NONE

 *

 *  Return values: NONE

 */

/* XXX this routine should be part of the public RTEMS interface */

rtems_boolean _TOD_Validate( rtems_time_of_day *tod );

int setRealTime(

  rtems_time_of_day *tod

)

{

  if (!RTC_Present)

    return -1;

  if ( !_TOD_Validate(tod) )

    return -1;

  RTC_Table[RTC_Minor].pDeviceFns->deviceSetTime(RTC_Minor, tod);

  return 0;

}

/*PAGE

 *

 *  checkRealTime

 *

 *  This routine reads the returns the variance betweent the real time and

 *  rtems time.

 *

 *  Input parameters: NONE

 *

 *  Output parameters:  NONE

 *

 *  Return values:

 *    int   The differance between the real time clock and rtems time.

 */

/* XXX this routine should be part of the public RTEMS interface */

unsigned32 _TOD_To_seconds( rtems_time_of_day *tod );

int checkRealTime()

{

  rtems_time_of_day rtems_tod;

  rtems_time_of_day rtc_tod;

  unsigned32 rtems_time;

  unsigned32 rtc_time;

  if (!RTC_Present)

    return -1;

  rtems_clock_get( RTEMS_CLOCK_GET_TOD, &rtems_tod );

  RTC_Table[RTC_Minor].pDeviceFns->deviceGetTime(RTC_Minor, &rtc_tod);

  rtems_time = _TOD_To_seconds( &rtems_tod );

  rtc_time = _TOD_To_seconds( &rtc_tod );

  return rtems_time - rtc_time;

}