source: rtems/c/src/lib/libbsp/i386/i386ex/clock/ckinit.c @ 34ef6c7

4.104.114.95
Last change on this file since 34ef6c7 was 34ef6c7, checked in by Joel Sherrill <joel.sherrill@…>, on Sep 5, 2008 at 10:06:51 PM

2008-09-05 Joel Sherrill <joel.sherrill@…>

  • clock/ckinit.c: The Shared Memory Driver no longer requires the special IOCTL in Clock_control. This was a hack which has existed since before the Classic API Timer Manager was implemented. All implementations of and references to Clock_control were removed.
  • Property mode set to 100644
File size: 3.2 KB
Line 
1/*  Clock_initialize
2 *
3 *  This routine initializes the Timer/Counter on the Intel
4 *  386ex evaluation board.
5 *
6 *  The tick frequency is 1 millisecond.
7 *
8 *  Input parameters:  NONE
9 *
10 *  Output parameters:  NONE
11 *
12 *  COPYRIGHT (c) 1989-1999.
13 *  On-Line Applications Research Corporation (OAR).
14 *
15 *  The license and distribution terms for this file may be
16 *  found in the file LICENSE in this distribution or at
17 *  http://www.rtems.com/license/LICENSE.
18 *
19 *  $Id$
20 */
21#define TMR0      0xF040
22#define TMR1      0xF041
23#define TMR2      0xF042
24#define TMRCON    0xF043
25#define TMRCFG    0xF834
26
27#include <bsp.h>
28#include <bsp/irq.h>
29
30#include <rtems/libio.h>
31
32#include <stdlib.h>
33
34uint32_t         Clock_isrs;              /* ISRs until next tick */
35static uint32_t         Clock_initial_isr_value;
36
37volatile uint32_t         Clock_driver_ticks;
38
39void Clock_exit( void );
40
41/*
42 * These are set by clock driver during its init
43 */
44
45rtems_device_major_number rtems_clock_major = ~0;
46rtems_device_major_number rtems_clock_minor = 0;
47
48/*
49 *  This is the ISR handler.
50 */
51
52void Clock_isr()
53{
54  /* enable_tracing(); */
55  Clock_driver_ticks += 1;
56  if ( Clock_isrs == 1 ) {
57    rtems_clock_tick();
58    Clock_isrs = Clock_initial_isr_value; /* rtems_configuration_get_microseconds_per_tick() / 1000;*/
59  }
60  else
61    Clock_isrs -= 1;
62}
63
64void ClockOff(const rtems_irq_connect_data* unused)
65{
66  outport_byte  ( TMRCFG , 0x80 ); /* disable the counter timer */
67}
68
69void ClockOn(const rtems_irq_connect_data* unused)
70{
71  outport_byte    ( TMRCFG , 0x00 ); /* enable the counter timer */
72}
73
74int ClockIsOn(const rtems_irq_connect_data* unused)
75{
76  return ((i8259s_cache & 0x1) == 0);
77}
78
79static rtems_irq_connect_data clockIrqData = {BSP_PERIODIC_TIMER,
80                                              Clock_isr,
81                                              0,
82                                              ClockOn,
83                                              ClockOff,
84                                              ClockIsOn};
85
86rtems_device_driver Clock_initialize(
87  rtems_device_major_number major,
88  rtems_device_minor_number minor,
89  void *pargp
90)
91{
92  unsigned timer_counter_init_value;
93  unsigned char clock_lsb, clock_msb;
94
95  Clock_driver_ticks = 0;
96
97  Clock_isrs =
98    Clock_initial_isr_value =
99    rtems_configuration_get_microseconds_per_tick() / 1000; /* ticks per clock_isr */
100
101  /*
102   * configure the counter timer ( should be based on microsecs/tick )
103   * NB. The divisor(Clock_isrs) resolves the  is the same number that appears in confdefs.h
104   * when setting the microseconds_per_tick value.
105   */
106  ClockOff      ( &clockIrqData );
107
108  timer_counter_init_value  =  rtems_configuration_get_microseconds_per_tick() / Clock_isrs;
109  clock_lsb = (unsigned char)timer_counter_init_value;
110  clock_msb = timer_counter_init_value >> 8;
111
112  outport_byte  ( TMRCON , 0x34 );
113  outport_byte  ( TMR0   , clock_lsb );       /* load LSB first */
114  outport_byte  ( TMR0   , clock_msb );  /* then MSB       */
115
116  if (!BSP_install_rtems_irq_handler (&clockIrqData)) {
117    printk("Unable to initialize system clock\n");
118    rtems_fatal_error_occurred(1);
119  }
120
121  /*
122   * make major/minor avail to others such as shared memory driver
123   */
124
125  rtems_clock_major = major;
126  rtems_clock_minor = minor;
127
128  return RTEMS_SUCCESSFUL;
129}
130
131void Clock_exit()
132{
133  ClockOff(&clockIrqData);
134  BSP_remove_rtems_irq_handler (&clockIrqData);
135}
Note: See TracBrowser for help on using the repository browser.