diff options
author | patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3> | 2008-03-23 14:11:49 +0000 |
---|---|---|
committer | patacongo <patacongo@42af7a65-404d-4744-a932-0658087f49c3> | 2008-03-23 14:11:49 +0000 |
commit | 9f5cbc8558ad8f3de344357f7745e28123df87ad (patch) | |
tree | e03ed88f06e6650321298af721b829d4778af6b2 | |
parent | b1f8b5dc366c4183add0ae26eae9e671294a3ce6 (diff) | |
download | px4-nuttx-9f5cbc8558ad8f3de344357f7745e28123df87ad.tar.gz px4-nuttx-9f5cbc8558ad8f3de344357f7745e28123df87ad.tar.bz2 px4-nuttx-9f5cbc8558ad8f3de344357f7745e28123df87ad.zip |
Add timer logic
git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@744 42af7a65-404d-4744-a932-0658087f49c3
-rw-r--r-- | nuttx/arch/z80/src/ez80/chip.h | 2 | ||||
-rw-r--r-- | nuttx/arch/z80/src/ez80/ez80_serial.c | 2 | ||||
-rw-r--r-- | nuttx/arch/z80/src/ez80/ez80_timerisr.c | 172 |
3 files changed, 174 insertions, 2 deletions
diff --git a/nuttx/arch/z80/src/ez80/chip.h b/nuttx/arch/z80/src/ez80/chip.h index 4adcb129b..9ae1b59f4 100644 --- a/nuttx/arch/z80/src/ez80/chip.h +++ b/nuttx/arch/z80/src/ez80/chip.h @@ -123,7 +123,7 @@ # define EZ80_TMRCLKDIV_256 0x18 /* 11: 256 */ #define EZ80_TMRCTL_TIMCONT 0x04 /* Bit 2: Continusous mode */ #define EZ80_TMRCTL_RLD 0x02 /* Bit 1: Force reload */ -#define EZ80_TMRCTL_TIMEN /* Bit 7: Programmable reload timer enabled */ +#define EZ80_TMRCTL_TIMEN 0x01 /* Bit 0: Programmable reload timer enabled */ /* TMR0/1/2/3 IER Register Bit Definitions *******************************************/ /* Bit 7: Reserved */ diff --git a/nuttx/arch/z80/src/ez80/ez80_serial.c b/nuttx/arch/z80/src/ez80/ez80_serial.c index 21c6a71ab..8dd2d7fbe 100644 --- a/nuttx/arch/z80/src/ez80/ez80_serial.c +++ b/nuttx/arch/z80/src/ez80/ez80_serial.c @@ -65,7 +65,7 @@ /* The system clock frequency is defined in the linkcmd file */ -extern _Erom unsigned long SYS_CLK_FREQ; +extern unsigned long SYS_CLK_FREQ; #define _DEFCLK ((unsigned long)&SYS_CLK_FREQ) /**************************************************************************** diff --git a/nuttx/arch/z80/src/ez80/ez80_timerisr.c b/nuttx/arch/z80/src/ez80/ez80_timerisr.c new file mode 100644 index 000000000..7f371ad57 --- /dev/null +++ b/nuttx/arch/z80/src/ez80/ez80_timerisr.c @@ -0,0 +1,172 @@ +/*************************************************************************** + * arch/z80/src/ez80/ez80_timerisr.c + * + * Copyright (C) 2008 Gregory Nutt. All rights reserved. + * Author: Gregory Nutt <spudmonkey@racsa.co.cr> + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in + * the documentation and/or other materials provided with the + * distribution. + * 3. Neither the name NuttX nor the names of its contributors may be + * used to endorse or promote products derived from this software + * without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS + * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT + * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS + * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE + * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, + * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS + * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED + * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT + * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN + * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE + * POSSIBILITY OF SUCH DAMAGE. + * + ***************************************************************************/ + +/*************************************************************************** + * Included Files + ***************************************************************************/ + +#include <nuttx/config.h> + +#include <sys/types.h> +#include <debug.h> + +#include <nuttx/arch.h> + +#include "chip/chip.h" +#include "clock_internal.h" +#include "up_internal.h" + +/*************************************************************************** + * Definitions + ***************************************************************************/ + +/* The system clock frequency is defined in the linkcmd file */ + +extern unsigned long SYS_CLK_FREQ; +#define _DEFCLK ((unsigned long)&SYS_CLK_FREQ) + +/*************************************************************************** + * Private Types + ***************************************************************************/ + +/*************************************************************************** + * Private Functions + ***************************************************************************/ + +/*************************************************************************** + * Public Functions + ***************************************************************************/ + +/*************************************************************************** + * Function: up_timerisr + * + * Description: + * The timer ISR will perform a variety of services for various portions + * of the system. + * + ***************************************************************************/ + +int up_timerisr(int irq, chipreg_t *regs) +{ + ubyte reg; + + /* Read the appropropriate timer0 registr to clear the interrupt */ + +#ifdef _EZ80F91 + reg = getreg8(EZ80_TMR0_IIR); +#else + /* _EZ80190, _EZ80L92, _EZ80F92, _EZ80F93 */ + + reg = getreg8(EZ80_TMR0_CTL); +#endif + + /* Process timer interrupt */ + + sched_process_timer(); + return 0; +} + +/*************************************************************************** + * Function: up_timerinit + * + * Description: + * This function is called during start-up to initialize the timer + * interrupt. + * + ***************************************************************************/ + +void up_timerinit(void) +{ + uint16 reload; + ubyte reg; + + /* Disable timer0 interrupts */ + + up_disable_irq(EZ80_IRQ_SYSTIMER); + + /* Disable the timer */ + + putreg8(0x00, EZ80_TMR0_CTL); + + /* Set up the timer reload value */ + /* Write to the timer reload register to set the reload value. + * + * In continuous mode: + * + * timer_period = reload_value x clock_divider / system_clock_frequency + * or + * reload_value = (timer_period * system_clock_frequency) / clock_divider + * + * For timer_period=10mS, and clock_divider=16, that would yield: + * + * reload_value = system_clock_frequency / 1600 + * + * For a system timer of 50,000,000 that would result in a reload value of + * 31,250 + */ + + reload = (uint16)(_DEFCLK / 1600); + putreg8((ubyte)(reload >> 8), EZ80_TMR0_RRH); + putreg8((ubyte)(reload), EZ80_TMR0_RRL); + + /* Clear any pending timer interrupts */ + +#if defined(_EZ80F91) + reg = getreg8(EZ80_TMR0_IIR); +#elif defined(_EZ80L92) || defined(_EZ80F92) ||defined(_EZ80F93) + reg = getreg8(EZ80_TMR0_CTL); +#endif + + /* Configure and enable the timer */ + +#if defined(_EZ80190) + putreg8(0x5f, EZ80_TMR0_CTL); +#elif defined(_EZ80F91) + putreg8((EZ80_TMRCLKDIV_16|EZ80_TMRCTL_TIMCONT|EZ80_TMRCTL_RLD|EZ80_TMRCTL_TIMEN), EZ80_TMR0_CTL); +#elif defined(_EZ80L92) || defined(_EZ80F92) ||defined(_EZ80F93) + putreg8(0x57, EZ80_TMR0_CTL); +#endif + +/* Enable timer end-of-count interrupts */ + +#if defined(_EZ80F91) + putreg8(EZ80_TMRIER_EOCEN, EZ80_TMR0_IER); +#endif + + /* Attach and enable the timer */ + + irq_attach(EZ80_IRQ_SYSTIMER, (xcpt_t)up_timerisr); + up_enable_irq(EZ80_IRQ_SYSTIMER); +} |