1 |
786 |
skrzyp |
//==========================================================================
|
2 |
|
|
//
|
3 |
|
|
// hal_intr.c
|
4 |
|
|
//
|
5 |
|
|
// PowerPC interrupt handlers
|
6 |
|
|
//
|
7 |
|
|
//==========================================================================
|
8 |
|
|
// ####ECOSGPLCOPYRIGHTBEGIN####
|
9 |
|
|
// -------------------------------------------
|
10 |
|
|
// This file is part of eCos, the Embedded Configurable Operating System.
|
11 |
|
|
// Copyright (C) 1998, 1999, 2000, 2001, 2002, 2003 Free Software Foundation, Inc.
|
12 |
|
|
//
|
13 |
|
|
// eCos is free software; you can redistribute it and/or modify it under
|
14 |
|
|
// the terms of the GNU General Public License as published by the Free
|
15 |
|
|
// Software Foundation; either version 2 or (at your option) any later
|
16 |
|
|
// version.
|
17 |
|
|
//
|
18 |
|
|
// eCos is distributed in the hope that it will be useful, but WITHOUT
|
19 |
|
|
// ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
20 |
|
|
// FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
21 |
|
|
// for more details.
|
22 |
|
|
//
|
23 |
|
|
// You should have received a copy of the GNU General Public License
|
24 |
|
|
// along with eCos; if not, write to the Free Software Foundation, Inc.,
|
25 |
|
|
// 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
|
26 |
|
|
//
|
27 |
|
|
// As a special exception, if other files instantiate templates or use
|
28 |
|
|
// macros or inline functions from this file, or you compile this file
|
29 |
|
|
// and link it with other works to produce a work based on this file,
|
30 |
|
|
// this file does not by itself cause the resulting work to be covered by
|
31 |
|
|
// the GNU General Public License. However the source code for this file
|
32 |
|
|
// must still be made available in accordance with section (3) of the GNU
|
33 |
|
|
// General Public License v2.
|
34 |
|
|
//
|
35 |
|
|
// This exception does not invalidate any other reasons why a work based
|
36 |
|
|
// on this file might be covered by the GNU General Public License.
|
37 |
|
|
// -------------------------------------------
|
38 |
|
|
// ####ECOSGPLCOPYRIGHTEND####
|
39 |
|
|
//==========================================================================
|
40 |
|
|
//#####DESCRIPTIONBEGIN####
|
41 |
|
|
//
|
42 |
|
|
// Author(s): jskov
|
43 |
|
|
// Contributors: jskov
|
44 |
|
|
// Date: 1999-02-20
|
45 |
|
|
// Purpose: PowerPC interrupt handlers
|
46 |
|
|
// Description: This file contains code to handle interrupt related issues
|
47 |
|
|
// on the PowerPC.
|
48 |
|
|
//
|
49 |
|
|
//####DESCRIPTIONEND####
|
50 |
|
|
//
|
51 |
|
|
//==========================================================================
|
52 |
|
|
|
53 |
|
|
#include <pkgconf/hal.h>
|
54 |
|
|
|
55 |
|
|
#include <cyg/hal/hal_intr.h>
|
56 |
|
|
|
57 |
|
|
static unsigned long ticks_per_us;
|
58 |
|
|
|
59 |
|
|
externC void
|
60 |
|
|
hal_IRQ_init(void)
|
61 |
|
|
{
|
62 |
|
|
// No architecture general initialization, but the variant may have
|
63 |
|
|
// provided some.
|
64 |
|
|
hal_variant_IRQ_init();
|
65 |
|
|
|
66 |
|
|
// Initialize real-time clock (for delays, etc, even if kernel doesn't use it)
|
67 |
|
|
HAL_CLOCK_INITIALIZE(CYGNUM_HAL_RTC_PERIOD);
|
68 |
|
|
|
69 |
|
|
// Pre-calculate this factor to avoid the extra calculations on each delay
|
70 |
|
|
ticks_per_us = ((long long)1 * (CYGNUM_HAL_RTC_PERIOD * 100)) / 1000000;
|
71 |
|
|
}
|
72 |
|
|
|
73 |
|
|
// Delay for some number of useconds.
|
74 |
|
|
externC void
|
75 |
|
|
hal_delay_us(int us)
|
76 |
|
|
{
|
77 |
|
|
cyg_int32 old_dec, new_dec;
|
78 |
|
|
long ticks;
|
79 |
|
|
int diff;
|
80 |
|
|
|
81 |
|
|
// Note: the system constant CYGNUM_HAL_RTC_PERIOD corresponds to 10,000us
|
82 |
|
|
// Scale the desired number of microseconds to be a number of decrementer ticks
|
83 |
|
|
if (ticks_per_us > 0) {
|
84 |
|
|
ticks = us * ticks_per_us;
|
85 |
|
|
} else {
|
86 |
|
|
ticks = ((long long)us * (CYGNUM_HAL_RTC_PERIOD * 100)) / 1000000;
|
87 |
|
|
}
|
88 |
|
|
asm volatile("mfdec %0;" : "=r"(old_dec) : );
|
89 |
|
|
while (ticks > 0) {
|
90 |
|
|
do {
|
91 |
|
|
asm volatile("mfdec %0;" : "=r"(new_dec) : );
|
92 |
|
|
} while (old_dec == new_dec);
|
93 |
|
|
if (new_dec < 0) {
|
94 |
|
|
HAL_CLOCK_RESET(0, CYGNUM_HAL_RTC_PERIOD);
|
95 |
|
|
}
|
96 |
|
|
diff = (old_dec - new_dec);
|
97 |
|
|
if (diff < 1) diff = 1;
|
98 |
|
|
old_dec = new_dec;
|
99 |
|
|
ticks -= diff;
|
100 |
|
|
}
|
101 |
|
|
}
|
102 |
|
|
|
103 |
|
|
// -------------------------------------------------------------------------
|
104 |
|
|
// EOF hal_intr.c
|