ecos: packages/hal/arm/pid/current/src/pid

annotate packages/hal/arm/pid/current/src/pid_misc.c @ 3292:7f8e529b4d82 default tip

Fix FREESCALE_EDMA_NBYTES_MLOFFYES_MLOFF() so it works with negative offsets.

author	vae
date	Wed, 29 Apr 2015 23:31:48 +0000
parents	74dbf4c3f2e1
children

rev	line source
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	1 //==========================================================================
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	2 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	3 // pid_misc.c
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	4 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	5 // HAL misc board support code for ARM PID7
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	6 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	7 //==========================================================================
2729 74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	8 // ####ECOSGPLCOPYRIGHTBEGIN####
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	9 // -------------------------------------------
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	10 // This file is part of eCos, the Embedded Configurable Operating System.
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	11 // Copyright (C) 1998, 1999, 2000, 2001, 2002 Free Software Foundation, Inc.
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 154 diff changeset	12 //
2729 74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	13 // eCos is free software; you can redistribute it and/or modify it under
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	14 // the terms of the GNU General Public License as published by the Free
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	15 // Software Foundation; either version 2 or (at your option) any later
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	16 // version.
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 154 diff changeset	17 //
2729 74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	18 // eCos is distributed in the hope that it will be useful, but WITHOUT
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	19 // ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	20 // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	21 // for more details.
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 154 diff changeset	22 //
2729 74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	23 // You should have received a copy of the GNU General Public License
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	24 // along with eCos; if not, write to the Free Software Foundation, Inc.,
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	25 // 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 154 diff changeset	26 //
2729 74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	27 // As a special exception, if other files instantiate templates or use
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	28 // macros or inline functions from this file, or you compile this file
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	29 // and link it with other works to produce a work based on this file,
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	30 // this file does not by itself cause the resulting work to be covered by
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	31 // the GNU General Public License. However the source code for this file
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	32 // must still be made available in accordance with section (3) of the GNU
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	33 // General Public License v2.
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 154 diff changeset	34 //
2729 74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	35 // This exception does not invalidate any other reasons why a work based
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	36 // on this file might be covered by the GNU General Public License.
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	37 // -------------------------------------------
74dbf4c3f2e1 Update all copyright banners to reflect FSF ownership; fix and improve licence text. jlarmour parents: 210 diff changeset	38 // ####ECOSGPLCOPYRIGHTEND####
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	39 //==========================================================================
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	40 //#####DESCRIPTIONBEGIN####
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	41 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	42 // Author(s): gthomas
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	43 // Contributors: gthomas
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	44 // Date: 1999-02-20
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	45 // Purpose: HAL board support
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	46 // Description: Implementations of HAL board interfaces
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	47 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	48 //####DESCRIPTIONEND####
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	49 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	50 //===========================================================================*/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	51
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	52 #include <pkgconf/hal.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	53
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	54 #include <cyg/infra/cyg_type.h> // base types
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	55 #include <cyg/infra/cyg_trac.h> // tracing macros
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	56 #include <cyg/infra/cyg_ass.h> // assertion macros
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	57
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	58 #include <cyg/hal/hal_io.h> // IO macros
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	59 #include <cyg/hal/hal_arch.h> // Register state info
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	60 #include <cyg/hal/hal_diag.h>
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	61 #include <cyg/hal/hal_intr.h> // necessary?
108 ff3f181b64bd Merge from eCos master repository on 2000-07-04-20:42:44-BST jlarmour parents: 66 diff changeset	62 #include <cyg/hal/hal_if.h> // calling interface
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	63
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	64 /------------------------------------------------------------------------/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	65 // On-board timer
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	66 /------------------------------------------------------------------------/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	67
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	68 // Timer registers
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	69 #define CYG_DEVICE_TIMER1_BASE 0x0A800020
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	70 #define CYG_DEVICE_TIMER1_LOAD \
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	71 ((volatile cyg_uint32 *) (CYG_DEVICE_TIMER1_BASE + 0x00))
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	72 // Load value, read/write
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	73 #define CYG_DEVICE_TIMER1_CURRENT \
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	74 ((volatile cyg_uint32 *) (CYG_DEVICE_TIMER1_BASE + 0x04))
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	75 // Current value, read
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	76 #define CYG_DEVICE_TIMER1_CONTROL \
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	77 ((volatile cyg_uint32 *) (CYG_DEVICE_TIMER1_BASE + 0x08))
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	78 // Control register, read/write
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	79 #define CYG_DEVICE_TIMER1_CLEAR \
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	80 ((volatile cyg_uint32 *) (CYG_DEVICE_TIMER1_BASE + 0x0C))
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	81 // Clears interrrupt, write only
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	82
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	83 #define CYG_DEVICE_TIMER_BASE 0x0A800020
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	84 #define CYG_DEVICE_TIMER_LOAD \
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	85 ((volatile cyg_uint32 *) (CYG_DEVICE_TIMER_BASE + 0x00))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	86 // Load value, read/write
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	87 #define CYG_DEVICE_TIMER_CURRENT \
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	88 ((volatile cyg_uint32 *) (CYG_DEVICE_TIMER_BASE + 0x04))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	89 // Current value, read
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	90 #define CYG_DEVICE_TIMER_CONTROL \
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	91 ((volatile cyg_uint32 *) (CYG_DEVICE_TIMER_BASE + 0x08))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	92 // Control register, read/write
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	93 #define CYG_DEVICE_TIMER_CLEAR \
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	94 ((volatile cyg_uint32 *) (CYG_DEVICE_TIMER_BASE + 0x0C))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	95 // Clears interrrupt, write only
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	96
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	97 // Clock/timer control register
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	98 #define CTL_ENABLE 0x80 // Bit 7: 1 - counter enabled
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	99 #define CTL_DISABLE 0x00 // 0 - counter disabled
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	100 #define CTL_FREERUN 0x00 // Bit 6: 0 - free running counter
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	101 #define CTL_PERIODIC 0x40 // 1 - periodic timer mode
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	102 #define CTL_SCALE_1 0x00 // Bits 32: 00 - Scale clock by 1
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	103 #define CTL_SCALE_16 0x04 // 01 - Scale by 16
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	104 #define CTL_SCALE_256 0x08 // 10 - Scale by 256
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	105 // 12.8us/tick
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	106
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	107 // Interrupt controller registers
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	108 #define CYG_DEVICE_ICTL_BASE 0x0A000000
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	109 #define CYG_DEVICE_IRQ_Status \
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	110 ((volatile cyg_uint32 *) (CYG_DEVICE_ICTL_BASE + 0x00))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	111 // Current status, read only
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	112 #define CYG_DEVICE_IRQ_Enable \
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	113 ((volatile cyg_uint32 *) (CYG_DEVICE_ICTL_BASE + 0x08))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	114 // Enable status, read only
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	115 #define CYG_DEVICE_IRQ_EnableSet \
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	116 ((volatile cyg_uint32 *) (CYG_DEVICE_ICTL_BASE + 0x08))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	117 // Enable (1's only), write only
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	118 #define CYG_DEVICE_IRQ_EnableClear \
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	119 ((volatile cyg_uint32 *) (CYG_DEVICE_ICTL_BASE + 0x0C))
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	120 // Disable (1's only), write only
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	121
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	122 static cyg_uint32 _period;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	123
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	124 void hal_clock_initialize(cyg_uint32 period)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	125 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	126 //diag_init(); diag_printf("%s(%d)\n", __PRETTY_FUNCTION__, period);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	127 //diag_printf("psr = %x\n", psr());
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	128 HAL_WRITE_UINT32(CYG_DEVICE_TIMER_CONTROL, CTL_DISABLE); // Turn off
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	129 HAL_WRITE_UINT32(CYG_DEVICE_TIMER_LOAD, period);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	130 HAL_WRITE_UINT32(CYG_DEVICE_TIMER_CONTROL,
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	131 CTL_ENABLE \| CTL_PERIODIC \| CTL_SCALE_16);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	132 _period = period;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	133 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	134
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	135 void hal_clock_reset(cyg_uint32 vector, cyg_uint32 period)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	136 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	137 //diag_init(); diag_printf("%s\n", __PRETTY_FUNCTION__);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	138 HAL_WRITE_UINT32(CYG_DEVICE_TIMER_CLEAR, 0);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	139 _period = period;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	140 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	141
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	142 void hal_clock_read(cyg_uint32 *pvalue)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	143 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	144 cyg_uint32 value;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	145 // diag_init(); diag_printf("%s\n", __PRETTY_FUNCTION__);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	146 HAL_READ_UINT32(CYG_DEVICE_TIMER_CURRENT, value);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	147 value &= 0xFFFF;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	148 *pvalue = _period - (value & 0xFFFF); // Note: counter is only 16 bits
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	149 // and decreases
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	150 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	151
154 e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	152 // -------------------------------------------------------------------------
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	153 //
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	154 // Delay for some number of micro-seconds
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	155 //
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	156 void hal_delay_us(cyg_int32 usecs)
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	157 {
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	158 cyg_uint32 value;
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	159 cyg_uint64 ticks = ((usecsCYGNUM_HAL_RTC_PERIODCYGNUM_HAL_RTC_DENOMINATOR)/1000000);
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	160
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	161 HAL_WRITE_UINT32(CYG_DEVICE_TIMER1_CONTROL, CTL_DISABLE); // Turn off
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	162 HAL_WRITE_UINT32(CYG_DEVICE_TIMER1_LOAD, ticks);
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	163 HAL_WRITE_UINT32(CYG_DEVICE_TIMER1_CONTROL,
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	164 CTL_ENABLE \| CTL_FREERUN \| CTL_SCALE_16);
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	165
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	166 // Wait for timer to underflow
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	167 do {
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	168 HAL_READ_UINT32(CYG_DEVICE_TIMER_CURRENT, value);
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	169 value &= 0xFFFF;
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	170 } while (value < 0x7fff);
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	171
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	172 HAL_WRITE_UINT32(CYG_DEVICE_TIMER1_CONTROL, CTL_DISABLE); // Turn off
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	173 }
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	174
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	175 // -------------------------------------------------------------------------
e2d866e32dac Merge from eCos master repository on 2001-02-26-23:18:05-GMT jlarmour parents: 152 diff changeset	176
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	177 void hal_hardware_init(void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	178 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	179 // Any hardware/platform initialization that needs to be done.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	180 HAL_WRITE_UINT32(CYG_DEVICE_IRQ_EnableClear, 0xFFFF); // Clear all
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	181 // interrupt sources
108 ff3f181b64bd Merge from eCos master repository on 2000-07-04-20:42:44-BST jlarmour parents: 66 diff changeset	182 // Set up eCos/ROM interfaces
ff3f181b64bd Merge from eCos master repository on 2000-07-04-20:42:44-BST jlarmour parents: 66 diff changeset	183 hal_if_init();
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	184 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	185
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	186 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	187 // This routine is called to respond to a hardware interrupt (IRQ). It
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	188 // should interrogate the hardware and return the IRQ vector number.
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	189
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	190 int hal_IRQ_handler(void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	191 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	192 // Do hardware-level IRQ handling
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	193 int irq_status, vector;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	194 HAL_READ_UINT32(CYG_DEVICE_IRQ_Status, irq_status);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	195 //diag_init(); diag_printf("%s, status: %x\n", __PRETTY_FUNCTION__, irq_status);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	196 for (vector = 1; vector < 16; vector++) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	197 if (irq_status & (1<<vector)) return vector;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	198 }
152 f935b880e96c Merge from eCos master repository on 2001-02-14-01:27:14-GMT jlarmour parents: 151 diff changeset	199 return CYGNUM_HAL_INTERRUPT_NONE; // This shouldn't happen!
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	200 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	201
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	202 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	203 // Interrupt control
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	204 //
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	205
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	206 void hal_interrupt_mask(int vector)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	207 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	208 //diag_init(); diag_printf("%s(%d)\n", __PRETTY_FUNCTION__, vector);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	209 HAL_WRITE_UINT32(CYG_DEVICE_IRQ_EnableClear, 1<<vector);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	210 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	211
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	212 #if 0
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	213 void hal_interrupt_status(void)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	214 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	215 int irq_status, irq_enable, timer_status, timer_value, timer_load;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	216 HAL_READ_UINT32(CYG_DEVICE_IRQ_Status, irq_status);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	217 HAL_READ_UINT32(CYG_DEVICE_IRQ_Enable, irq_enable);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	218 HAL_READ_UINT32(CYG_DEVICE_TIMER_LOAD, timer_load);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	219 HAL_READ_UINT32(CYG_DEVICE_TIMER_CURRENT, timer_value);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	220 HAL_READ_UINT32(CYG_DEVICE_TIMER_CONTROL, timer_status);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	221 diag_printf("Interrupt: IRQ: %x.%x, TIMER: %x.%x.%x, psr: %x\n",
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	222 irq_status, irq_enable, timer_status, timer_value,
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	223 timer_load, psr());
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	224 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	225 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	226
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	227 void hal_interrupt_unmask(int vector)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	228 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	229 //diag_init(); diag_printf("%s(%d)\n", __PRETTY_FUNCTION__, vector);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	230 HAL_WRITE_UINT32(CYG_DEVICE_IRQ_EnableSet, 1<<vector);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	231 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	232
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	233 void hal_interrupt_acknowledge(int vector)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	234 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	235 //diag_init(); diag_printf("%s(%d)\n", __PRETTY_FUNCTION__, vector);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	236 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	237
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	238 void hal_interrupt_configure(int vector, int level, int up)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	239 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	240 //diag_init(); diag_printf("%s(%d,%d,%d)\n", __PRETTY_FUNCTION__, vector, level, up);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	241 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	242
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	243 void hal_interrupt_set_level(int vector, int level)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	244 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	245 //diag_init(); diag_printf("%s(%d,%d)\n", __PRETTY_FUNCTION__, vector, level);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	246 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	247
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	248 void hal_show_IRQ(int vector, int data, int handler)
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	249 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	250 // diag_printf("IRQ - vector: %x, data: %x, handler: %x\n", vector, data, handler);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	251 }
50 a0774359f013 Merge from eCos master repository on 1999-11-02-17:02:15-GMT jlarmour parents: 2 diff changeset	252
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	253 /---------------------------------------------------------------------------/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: diff changeset	254 /* End of hal_misc.c */

Mercurial > ecos

annotate packages/hal/arm/pid/current/src/pid_misc.c @ 3292:7f8e529b4d82 default tip