source: rtems/c/src/lib/libbsp/arm/shared/arm-a9mpcore-clock-config.c @ 936c8d6

4.115
Last change on this file since 936c8d6 was a91dc98b, checked in by Sebastian Huber <sebastian.huber@…>, on Apr 26, 2013 at 1:06:32 PM

bsp/realview-pbx-a9: New BSP

  • Property mode set to 100644
File size: 2.7 KB
Line 
1/*
2 * Copyright (c) 2013 embedded brains GmbH.  All rights reserved.
3 *
4 *  embedded brains GmbH
5 *  Dornierstr. 4
6 *  82178 Puchheim
7 *  Germany
8 *  <info@embedded-brains.de>
9 *
10 * The license and distribution terms for this file may be
11 * found in the file LICENSE in this distribution or at
12 * http://www.rtems.com/license/LICENSE.
13 */
14
15#include <bsp.h>
16#include <bsp/irq.h>
17#include <bsp/arm-a9mpcore-regs.h>
18
19#define A9MPCORE_PT ((volatile a9mpcore_pt *) BSP_ARM_A9MPCORE_PT_BASE)
20
21/* This is defined in clockdrv_shell.h */
22void Clock_isr(rtems_irq_hdl_param arg);
23
24static void a9mpcore_clock_at_tick(void)
25{
26  volatile a9mpcore_pt *pt = A9MPCORE_PT;
27
28  pt->irqst = A9MPCORE_PT_IRQST_EFLG;
29}
30
31static void a9mpcore_clock_handler_install(void)
32{
33  rtems_status_code sc;
34
35  sc = rtems_interrupt_handler_install(
36    A9MPCORE_IRQ_PT,
37    "Clock",
38    RTEMS_INTERRUPT_UNIQUE,
39    (rtems_interrupt_handler) Clock_isr,
40    NULL
41  );
42  if (sc != RTEMS_SUCCESSFUL) {
43    rtems_fatal(
44      RTEMS_FATAL_SOURCE_BSP_SPECIFIC,
45      BSP_ARM_A9MPCORE_FATAL_CLOCK_IRQ_INSTALL
46    );
47  }
48}
49
50static void a9mpcore_clock_initialize(void)
51{
52  volatile a9mpcore_pt *pt = A9MPCORE_PT;
53  uint64_t interval = ((uint64_t) BSP_ARM_A9MPCORE_PERIPHCLK
54    * (uint64_t) rtems_configuration_get_microseconds_per_tick()) / 1000000;
55
56  pt->load = (uint32_t) interval - 1;
57  pt->ctrl = A9MPCORE_PT_CTRL_AUTO_RLD
58    | A9MPCORE_PT_CTRL_IRQ_EN
59    | A9MPCORE_PT_CTRL_TMR_EN;
60}
61
62static void a9mpcore_clock_cleanup(void)
63{
64  volatile a9mpcore_pt *pt = A9MPCORE_PT;
65  rtems_status_code sc;
66
67  pt->ctrl = 0;
68  pt->irqst = A9MPCORE_PT_IRQST_EFLG;
69
70  sc = rtems_interrupt_handler_remove(
71    A9MPCORE_IRQ_PT,
72    (rtems_interrupt_handler) Clock_isr,
73    NULL
74  );
75  if (sc != RTEMS_SUCCESSFUL) {
76    rtems_fatal(
77      RTEMS_FATAL_SOURCE_BSP_SPECIFIC,
78      BSP_ARM_A9MPCORE_FATAL_CLOCK_IRQ_REMOVE
79    );
80  }
81}
82
83static uint32_t a9mpcore_clock_nanoseconds_since_last_tick(void)
84{
85  volatile a9mpcore_pt *pt = A9MPCORE_PT;
86  uint64_t k = (1000000000ULL << 32) / BSP_ARM_A9MPCORE_PERIPHCLK;
87  uint32_t c = pt->cntr;
88  uint32_t p = pt->load + 1;
89
90  if ((pt->irqst & A9MPCORE_PT_IRQST_EFLG) != 0) {
91    c = pt->cntr + p;
92  }
93
94  return (uint32_t) (((p - c) * k) >> 32);
95}
96
97#define Clock_driver_support_at_tick() \
98  a9mpcore_clock_at_tick()
99
100#define Clock_driver_support_initialize_hardware() \
101  a9mpcore_clock_initialize()
102
103#define Clock_driver_support_install_isr(isr, old_isr) \
104  do { \
105    a9mpcore_clock_handler_install();   \
106    old_isr = NULL; \
107  } while (0)
108
109#define Clock_driver_support_shutdown_hardware() \
110  a9mpcore_clock_cleanup()
111
112#define Clock_driver_nanoseconds_since_last_tick \
113  a9mpcore_clock_nanoseconds_since_last_tick
114
115/* Include shared source clock driver code */
116#include "../../shared/clockdrv_shell.h"
Note: See TracBrowser for help on using the repository browser.