mirror of
https://github.com/PX4/PX4-Autopilot.git
synced 2026-05-28 19:32:36 +08:00
Add hooks for SD media change callbacks
git-svn-id: https://nuttx.svn.sourceforge.net/svnroot/nuttx/trunk@4267 7fd9a85b-ad96-42d3-883c-3090e2eb8679
This commit is contained in:
@@ -655,6 +655,7 @@ EXTERN void ssp_flush(FAR struct spi_dev_s *dev);
|
|||||||
*
|
*
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
#ifdef CONFIG_LPC17_SPI
|
#ifdef CONFIG_LPC17_SPI
|
||||||
EXTERN int lpc17_spiregister(FAR struct spi_dev_s *dev,
|
EXTERN int lpc17_spiregister(FAR struct spi_dev_s *dev,
|
||||||
spi_mediachange_t callback, void *arg);
|
spi_mediachange_t callback, void *arg);
|
||||||
@@ -669,6 +670,7 @@ EXTERN int lpc17_ssp0register(FAR struct spi_dev_s *dev,
|
|||||||
EXTERN int lpc17_ssp1register(FAR struct spi_dev_s *dev,
|
EXTERN int lpc17_ssp1register(FAR struct spi_dev_s *dev,
|
||||||
spi_mediachange_t callback, void *arg);
|
spi_mediachange_t callback, void *arg);
|
||||||
#endif
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* Name: lpc17_dmainitialize
|
* Name: lpc17_dmainitialize
|
||||||
|
|||||||
@@ -1,7 +1,7 @@
|
|||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* arch/arm/src/lpc17xx/lpc17_spi.c
|
* arch/arm/src/lpc17xx/lpc17_spi.c
|
||||||
*
|
*
|
||||||
* Copyright (C) 2010 Gregory Nutt. All rights reserved.
|
* Copyright (C) 2010, 2012 Gregory Nutt. All rights reserved.
|
||||||
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||||||
*
|
*
|
||||||
* Redistribution and use in source and binary forms, with or without
|
* Redistribution and use in source and binary forms, with or without
|
||||||
@@ -104,6 +104,8 @@
|
|||||||
* Private Types
|
* Private Types
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
/* This structure descibes the state of the SSP driver */
|
||||||
|
|
||||||
struct lpc17_spidev_s
|
struct lpc17_spidev_s
|
||||||
{
|
{
|
||||||
struct spi_dev_s spidev; /* Externally visible part of the SPI interface */
|
struct spi_dev_s spidev; /* Externally visible part of the SPI interface */
|
||||||
@@ -153,7 +155,11 @@ static const struct spi_ops_s g_spiops =
|
|||||||
.send = spi_send,
|
.send = spi_send,
|
||||||
.sndblock = spi_sndblock,
|
.sndblock = spi_sndblock,
|
||||||
.recvblock = spi_recvblock,
|
.recvblock = spi_recvblock,
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
.registercallback = lpc17_spiregister, /* Provided externally */
|
||||||
|
#else
|
||||||
.registercallback = 0, /* Not implemented */
|
.registercallback = 0, /* Not implemented */
|
||||||
|
#endif
|
||||||
};
|
};
|
||||||
|
|
||||||
static struct lpc17_spidev_s g_spidev =
|
static struct lpc17_spidev_s g_spidev =
|
||||||
@@ -597,5 +603,6 @@ FAR struct spi_dev_s *up_spiinitialize(int port)
|
|||||||
#endif
|
#endif
|
||||||
return &priv->spidev;
|
return &priv->spidev;
|
||||||
}
|
}
|
||||||
|
|
||||||
#endif /* CONFIG_LPC17_SPI */
|
#endif /* CONFIG_LPC17_SPI */
|
||||||
|
|
||||||
|
|||||||
@@ -1,7 +1,7 @@
|
|||||||
/****************************************************************************
|
/****************************************************************************
|
||||||
* arch/arm/src/lpc17xx/lpc17_ssp.c
|
* arch/arm/src/lpc17xx/lpc17_ssp.c
|
||||||
*
|
*
|
||||||
* Copyright (C) 2010-2011 Gregory Nutt. All rights reserved.
|
* Copyright (C) 2010-2012 Gregory Nutt. All rights reserved.
|
||||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||||
*
|
*
|
||||||
* Redistribution and use in source and binary forms, with or without
|
* Redistribution and use in source and binary forms, with or without
|
||||||
@@ -108,6 +108,8 @@
|
|||||||
* Private Types
|
* Private Types
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
|
/* This structure descibes the state of the SSP driver */
|
||||||
|
|
||||||
struct lpc17_sspdev_s
|
struct lpc17_sspdev_s
|
||||||
{
|
{
|
||||||
struct spi_dev_s spidev; /* Externally visible part of the SPI interface */
|
struct spi_dev_s spidev; /* Externally visible part of the SPI interface */
|
||||||
@@ -235,7 +237,7 @@ static struct lpc17_sspdev_s g_ssp1dev =
|
|||||||
* Private Functions
|
* Private Functions
|
||||||
****************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
/************************************************************************************
|
/****************************************************************************
|
||||||
* Name: ssp_getreg
|
* Name: ssp_getreg
|
||||||
*
|
*
|
||||||
* Description:
|
* Description:
|
||||||
@@ -248,14 +250,14 @@ static struct lpc17_sspdev_s g_ssp1dev =
|
|||||||
* Returned Value:
|
* Returned Value:
|
||||||
* The contents of the 32-bit register
|
* The contents of the 32-bit register
|
||||||
*
|
*
|
||||||
************************************************************************************/
|
****************************************************************************/
|
||||||
|
|
||||||
static inline uint32_t ssp_getreg(FAR struct lpc17_sspdev_s *priv, uint8_t offset)
|
static inline uint32_t ssp_getreg(FAR struct lpc17_sspdev_s *priv, uint8_t offset)
|
||||||
{
|
{
|
||||||
return getreg32(priv->sspbase + (uint32_t)offset);
|
return getreg32(priv->sspbase + (uint32_t)offset);
|
||||||
}
|
}
|
||||||
|
|
||||||
/************************************************************************************
|
/****************************************************************************
|
||||||
* Name: ssp_putreg
|
* Name: ssp_putreg
|
||||||
*
|
*
|
||||||
* Description:
|
* Description:
|
||||||
@@ -269,7 +271,7 @@ static inline uint32_t ssp_getreg(FAR struct lpc17_sspdev_s *priv, uint8_t offse
|
|||||||
* Returned Value:
|
* Returned Value:
|
||||||
* None
|
* None
|
||||||
*
|
*
|
||||||
************************************************************************************/
|
***************************************************************************/
|
||||||
|
|
||||||
static inline void ssp_putreg(FAR struct lpc17_sspdev_s *priv, uint8_t offset, uint32_t value)
|
static inline void ssp_putreg(FAR struct lpc17_sspdev_s *priv, uint8_t offset, uint32_t value)
|
||||||
{
|
{
|
||||||
|
|||||||
@@ -45,6 +45,10 @@
|
|||||||
#include <debug.h>
|
#include <debug.h>
|
||||||
|
|
||||||
#include <nuttx/spi.h>
|
#include <nuttx/spi.h>
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
#include <nuttx/irq.h>
|
||||||
|
#endif
|
||||||
|
|
||||||
#include <arch/board/board.h>
|
#include <arch/board/board.h>
|
||||||
|
|
||||||
#include "up_arch.h"
|
#include "up_arch.h"
|
||||||
@@ -57,7 +61,15 @@
|
|||||||
/************************************************************************************
|
/************************************************************************************
|
||||||
* Definitions
|
* Definitions
|
||||||
************************************************************************************/
|
************************************************************************************/
|
||||||
|
/* Configuration ************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
# ifndef CONFIG_GPIO_IRQ
|
||||||
|
# warning "CONFIG_GPIO_IRQ is required to support CONFIG_SPI_CALLBACK"
|
||||||
|
# endif
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* Debug ********************************************************************/
|
||||||
/* The following enable debug output from this file (needs CONFIG_DEBUG too).
|
/* The following enable debug output from this file (needs CONFIG_DEBUG too).
|
||||||
*
|
*
|
||||||
* CONFIG_SSP_DEBUG - Define to enable basic SSP debug
|
* CONFIG_SSP_DEBUG - Define to enable basic SSP debug
|
||||||
@@ -87,10 +99,113 @@
|
|||||||
# define ssp_dumpssp1gpio(m)
|
# define ssp_dumpssp1gpio(m)
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
/************************************************************************************
|
||||||
|
* Private Types
|
||||||
|
************************************************************************************/
|
||||||
|
|
||||||
|
/* This structure describes on media change callback */
|
||||||
|
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
struct lpc17_mediachange_s
|
||||||
|
{
|
||||||
|
spi_mediachange_t callback; /* The media change callback */
|
||||||
|
FAR void *arg; /* Callback argument */
|
||||||
|
};
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/************************************************************************************
|
||||||
|
* Private Data
|
||||||
|
************************************************************************************/
|
||||||
|
|
||||||
|
/* Registered media change callback */
|
||||||
|
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
#ifdef CONFIG_LPC17_SSP0
|
||||||
|
static struct lpc17_mediachange_s g_ssp0callback;
|
||||||
|
#endif
|
||||||
|
#ifdef CONFIG_LPC17_SSP1
|
||||||
|
static struct lpc17_mediachange_s g_ssp1callback;
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
/************************************************************************************
|
/************************************************************************************
|
||||||
* Private Functions
|
* Private Functions
|
||||||
************************************************************************************/
|
************************************************************************************/
|
||||||
|
|
||||||
|
/************************************************************************************
|
||||||
|
* Name: ssp_cdirqsetup
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Setup to receive a card detection interrupt
|
||||||
|
*
|
||||||
|
************************************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
static void ssp_cdirqsetup(int irq, xcpt_t irqhandler)
|
||||||
|
{
|
||||||
|
irqstate_t flags;
|
||||||
|
|
||||||
|
/* Disable interrupts until we are done */
|
||||||
|
|
||||||
|
flags = irqsave();
|
||||||
|
|
||||||
|
/* Configure the interrupt. Either attach and enable the new
|
||||||
|
* interrupt or disable and detach the old interrupt handler.
|
||||||
|
*/
|
||||||
|
|
||||||
|
if (irqhandler)
|
||||||
|
{
|
||||||
|
/* Attach then enable the new interrupt handler */
|
||||||
|
|
||||||
|
(void)irq_attach(irq, irqhandler);
|
||||||
|
up_enable_irq(irq);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
/* Disable then then detach the the old interrupt handler */
|
||||||
|
|
||||||
|
up_disable_irq(irq);
|
||||||
|
(void)irq_detach(irq);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/************************************************************************************
|
||||||
|
* Name: ssp0/1_cdinterrupt
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* Handle card detection interrupt
|
||||||
|
*
|
||||||
|
************************************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
#ifdef CONFIG_LPC17_SSP0
|
||||||
|
static int ssp0_cdinterrupt(int irq, FAR void *context)
|
||||||
|
{
|
||||||
|
/* Invoke the media change callback */
|
||||||
|
|
||||||
|
if (g_ssp0callback.callback)
|
||||||
|
{
|
||||||
|
g_ssp0callback.callback(g_ssp0callback.arg);
|
||||||
|
}
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_LPC17_SSP1
|
||||||
|
static int ssp1_cdinterrupt(int irq, FAR void *context)
|
||||||
|
{
|
||||||
|
/* Invoke the media change callback */
|
||||||
|
|
||||||
|
if (g_ssp1callback.callback)
|
||||||
|
{
|
||||||
|
g_ssp1callback.callback(g_ssp1callback.arg);
|
||||||
|
}
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
/************************************************************************************
|
/************************************************************************************
|
||||||
* Public Functions
|
* Public Functions
|
||||||
************************************************************************************/
|
************************************************************************************/
|
||||||
@@ -127,6 +242,12 @@ void weak_function lpc17_sspinitialize(void)
|
|||||||
lpc17_configgpio(LPC1766STK_MMC_PWR);
|
lpc17_configgpio(LPC1766STK_MMC_PWR);
|
||||||
ssp_dumpssp0gpio("AFTER SSP1 Initialization");
|
ssp_dumpssp0gpio("AFTER SSP1 Initialization");
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
/* If there were any CD detect pins for the LPC1766-STK, this is where
|
||||||
|
* they would be configured.
|
||||||
|
*/
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
/************************************************************************************
|
/************************************************************************************
|
||||||
@@ -196,4 +317,64 @@ uint8_t lpc17_ssp1status(FAR struct spi_dev_s *dev, enum spi_dev_e devid)
|
|||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
/************************************************************************************
|
||||||
|
* Name: lpc17_ssp0/1register
|
||||||
|
*
|
||||||
|
* Description:
|
||||||
|
* If the board supports a card detect callback to inform the SPI-based
|
||||||
|
* MMC/SD drvier when an SD card is inserted or removed, then
|
||||||
|
* CONFIG_SPI_CALLBACK should be defined and the following function(s) must
|
||||||
|
* must be implemented. These functiosn implements the registercallback
|
||||||
|
* method of the SPI interface (see include/nuttx/spi.h for details)
|
||||||
|
*
|
||||||
|
* Input Parameters:
|
||||||
|
* dev - Device-specific state data
|
||||||
|
* callback - The funtion to call on the media change
|
||||||
|
* arg - A caller provided value to return with the callback
|
||||||
|
*
|
||||||
|
* Returned Value:
|
||||||
|
* 0 on success; negated errno on failure.
|
||||||
|
*
|
||||||
|
************************************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_SPI_CALLBACK
|
||||||
|
#ifdef CONFIG_LPC17_SSP0
|
||||||
|
/* If there were any CD detect pins on the LPC1766-STK, this is how the
|
||||||
|
* would be configured.
|
||||||
|
*/
|
||||||
|
|
||||||
|
int lpc17_ssp0register(FAR struct spi_dev_s *dev, spi_mediachange_t callback, void *arg)
|
||||||
|
{
|
||||||
|
/* Save the callback information */
|
||||||
|
|
||||||
|
#if 0
|
||||||
|
g_ssp0callback.callback = callback;
|
||||||
|
g_ssp0callback.arg = arg;
|
||||||
|
|
||||||
|
/* Setup the interrupt */
|
||||||
|
|
||||||
|
spi_cdirqsetup(LPC1766STK_SPICD_IRQ, ssp0_cdinterrupt);
|
||||||
|
#endif
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef CONFIG_LPC17_SSP1
|
||||||
|
int lpc17_ssp1register(FAR struct spi_dev_s *dev, spi_mediachange_t callback, void *arg)
|
||||||
|
{
|
||||||
|
/* Save the callback information */
|
||||||
|
|
||||||
|
#if 0
|
||||||
|
g_ssp1callback.callback = callback;
|
||||||
|
g_ssp1callback.arg = arg;
|
||||||
|
|
||||||
|
/* Setup the interrupt */
|
||||||
|
|
||||||
|
spi_cdirqsetup(LPC1766STK_SPICD_IRQ, ssp1_cdinterrupt);
|
||||||
|
#endif
|
||||||
|
return OK;
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
#endif /* CONFIG_LPC17_SSP0 || CONFIG_LPC17_SSP1 */
|
#endif /* CONFIG_LPC17_SSP0 || CONFIG_LPC17_SSP1 */
|
||||||
|
|||||||
Reference in New Issue
Block a user