e8baad01bd
git-svn-id: svn://svn.code.sf.net/p/nuttx/code/trunk@2649 42af7a65-404d-4744-a932-0658087f49c3
322 lines
9.0 KiB
C
Executable File
322 lines
9.0 KiB
C
Executable File
/********************************************************************************
|
|
* arch/arm/src/str71x/str71x_xti.c
|
|
*
|
|
* Copyright (C) 2010 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 <stdint.h>
|
|
#include <nuttx/irq.h>
|
|
#include <nuttx/arch.h>
|
|
#include <assert.h>
|
|
#include <errno.h>
|
|
#include <debug.h>
|
|
|
|
#include <arch/board/board.h>
|
|
|
|
#include "chip.h"
|
|
#include "up_arch.h"
|
|
#include "os_internal.h"
|
|
#include "up_internal.h"
|
|
#include "str71x_internal.h"
|
|
|
|
#ifdef CONFIG_STR71X_XTI
|
|
|
|
/********************************************************************************
|
|
* Pre-procesor Definitions
|
|
********************************************************************************/
|
|
|
|
/********************************************************************************
|
|
* Private Types
|
|
********************************************************************************/
|
|
|
|
struct xtiregs_s
|
|
{
|
|
uint32_t mr; /* Mask register */
|
|
uint32_t tr; /* Trigger polarity register */
|
|
};
|
|
|
|
/********************************************************************************
|
|
* Public Data
|
|
********************************************************************************/
|
|
|
|
static const struct xtiregs_s g_xtiregs[2] =
|
|
{
|
|
{ STR71X_XTI_MRL, STR71X_XTI_TRL },
|
|
{ STR71X_XTI_MRH, STR71X_XTI_TRH }
|
|
};
|
|
|
|
/********************************************************************************
|
|
* Private Data
|
|
********************************************************************************/
|
|
|
|
/********************************************************************************
|
|
* Private Functions
|
|
********************************************************************************/
|
|
|
|
/********************************************************************************
|
|
* Name: str71x_xtiinterrupt
|
|
*
|
|
* Description:
|
|
* Dispatch an XTI interrupt.
|
|
*
|
|
********************************************************************************/
|
|
|
|
static int str71x_xtiinterrupt(int irq, FAR void *context)
|
|
{
|
|
uint16_t enabled = (uint16_t)getreg8(STR71X_XTI_MRH) << 8 |
|
|
(uint16_t)getreg8(STR71X_XTI_MRL);
|
|
uint16_t pending = (uint16_t)getreg8(STR71X_XTI_PRH) << 8 |
|
|
(uint16_t)getreg8(STR71X_XTI_PRL);
|
|
uint16_t mask;
|
|
|
|
/* Dispatch the interrupts, the actions performed by the interrupt
|
|
* handlers should clear the interrupt at the external source of the
|
|
* interrupt. We need to clear the interrupts at the source before
|
|
* clearing the pending interrupts (see below).
|
|
*/
|
|
|
|
pending &= enabled;
|
|
|
|
for (irq = STR71X_IRQ_FIRSTXTI, mask = 0x0001;
|
|
irq < NR_IRQS && pending != 0;
|
|
irq++, mask <<= 1)
|
|
{
|
|
/* Is this interrupt pending? */
|
|
|
|
if ((pending & mask) != 0)
|
|
{
|
|
/* Deliver the IRQ */
|
|
|
|
irq_dispatch(irq, context);
|
|
pending &= ~mask;
|
|
}
|
|
}
|
|
|
|
/* Clear the pending interrupts. This should be safe: "it is necessary to
|
|
* clear at least one pending bit: this operation allows a rising edge to be
|
|
* generated on the internal line (if there is at least one more pending bit
|
|
* set and not masked) and so to set the interrupt controller pending bit
|
|
* again.
|
|
*/
|
|
|
|
putreg8(0, STR71X_XTI_PRH);
|
|
putreg8(0, STR71X_XTI_PRL);
|
|
return OK;
|
|
}
|
|
|
|
/********************************************************************************
|
|
* Public Functions
|
|
********************************************************************************/
|
|
|
|
/********************************************************************************
|
|
* Name: str71x_xtiinitialize
|
|
*
|
|
* Description:
|
|
* Configure XTI for operation. Note that the lines are not used as wake-up
|
|
* sources in this implementation. Some extensions would be required for that
|
|
* capability.
|
|
*
|
|
********************************************************************************/
|
|
|
|
int str71x_xtiinitialize(void)
|
|
{
|
|
int ret;
|
|
|
|
/* Mask all interrupts by setting XTI MRH/L to zero */
|
|
|
|
putreg8(0, STR71X_XTI_MRH);
|
|
putreg8(0, STR71X_XTI_MRL);
|
|
|
|
/* Clear any pending interrupts by setting XTI PRH/L to zero */
|
|
|
|
putreg8(0, STR71X_XTI_PRH);
|
|
putreg8(0, STR71X_XTI_PRL);
|
|
|
|
/* Attach the XTI interrupt */
|
|
|
|
ret = irq_attach(STR71X_IRQ_XTI, str71x_xtiinterrupt);
|
|
if (ret == OK)
|
|
{
|
|
/* Enable the XTI interrupt at the XTI */
|
|
|
|
putreg8(STR71X_XTICTRL_ID1S, STR71X_XTI_CTRL);
|
|
|
|
/* And enable the XTI interrupt at the interrupt controller */
|
|
|
|
up_enable_irq(STR71X_IRQ_XTI);
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/********************************************************************************
|
|
* Name: str71x_xticonfig
|
|
*
|
|
* Description:
|
|
* Configure an external line to provide interrupts.
|
|
*
|
|
********************************************************************************/
|
|
|
|
int str71x_xticonfig(int irq, bool rising)
|
|
{
|
|
uint8_t regval;
|
|
int bit;
|
|
int ndx;
|
|
int ret = -EINVAL;
|
|
|
|
/* Configure one of the 16 lines as an interrupt source */
|
|
|
|
if (irq >= STR71X_IRQ_FIRSTXTI && irq <= NR_IRQS)
|
|
{
|
|
/* Make sure that the interrupt is disabled */
|
|
|
|
str71x_disable_xtiirq(irq);
|
|
|
|
/* Decide if we use the lower or upper regiser */
|
|
|
|
bit = irq - STR71X_IRQ_FIRSTXTI;
|
|
ndx = 0;
|
|
if (bit > 7)
|
|
{
|
|
/* Select the high register */
|
|
|
|
bit -= 8;
|
|
ndx = 1;
|
|
}
|
|
|
|
/* Set the rising or trailing edge */
|
|
|
|
regval = getreg8(g_xtiregs[ndx].tr);
|
|
if (rising)
|
|
{
|
|
regval |= (1 << bit);
|
|
}
|
|
else
|
|
{
|
|
regval &= ~(1 << bit);
|
|
}
|
|
putreg8(regval, g_xtiregs[ndx].tr);
|
|
|
|
/* Return success */
|
|
|
|
ret = OK;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: str71x_enable_xtiirq
|
|
*
|
|
* Description:
|
|
* Enable an external interrupt.
|
|
*
|
|
****************************************************************************/
|
|
|
|
void str71x_enable_xtiirq(int irq)
|
|
{
|
|
uint8_t regval;
|
|
int bit;
|
|
int ndx;
|
|
|
|
/* Enable the external interrupt */
|
|
|
|
if (irq >= STR71X_IRQ_FIRSTXTI && irq <= NR_IRQS)
|
|
{
|
|
/* Decide if we use the lower or upper regiser */
|
|
|
|
bit = irq - STR71X_IRQ_FIRSTXTI;
|
|
ndx = 0;
|
|
if (bit > 7)
|
|
{
|
|
/* Select the high register */
|
|
|
|
bit -= 8;
|
|
ndx = 1;
|
|
}
|
|
|
|
/* Enable the interrupt be setting the corresponding mask bit
|
|
* the XTI_MRL/H register.
|
|
*/
|
|
|
|
regval = getreg8(g_xtiregs[ndx].mr);
|
|
regval |= (1 << bit);
|
|
putreg8(regval, g_xtiregs[ndx].mr);
|
|
}
|
|
}
|
|
|
|
/****************************************************************************
|
|
* Name: str71x_disable_xtiirq
|
|
*
|
|
* Description:
|
|
* Disable an external interrupt.
|
|
*
|
|
****************************************************************************/
|
|
|
|
void str71x_disable_xtiirq(int irq)
|
|
{
|
|
uint8_t regval;
|
|
int bit;
|
|
int ndx;
|
|
|
|
/* Disable the external interrupt */
|
|
|
|
if (irq >= STR71X_IRQ_FIRSTXTI && irq <= NR_IRQS)
|
|
{
|
|
/* Decide if we use the lower or upper regiser */
|
|
|
|
bit = irq - STR71X_IRQ_FIRSTXTI;
|
|
ndx = 0;
|
|
if (bit > 7)
|
|
{
|
|
/* Select the high register */
|
|
|
|
bit -= 8;
|
|
ndx = 1;
|
|
}
|
|
|
|
/* Disable the interrupt be clearing the corresponding mask bit
|
|
* the XTI_MRL/H register.
|
|
*/
|
|
|
|
regval = getreg8(g_xtiregs[ndx].mr);
|
|
regval &= ~(1 << bit);
|
|
putreg8(regval, g_xtiregs[ndx].mr);
|
|
}
|
|
}
|
|
|
|
#endif /* CONFIG_STR71X_XTI */
|