forked from Archive/PX4-Autopilot
Support for relays on the Shenzhou board (Darcy Gong)
git-svn-id: http://svn.code.sf.net/p/nuttx/code/trunk@5266 42af7a65-404d-4744-a932-0658087f49c3
This commit is contained in:
patacongo
parent
1f1319f25b
commit
54aa383686
|
|
@ -422,6 +422,28 @@ EXTERN void stm32_setleds(uint8_t ledset);
|
|||
|
||||
EXTERN void stm32_lcdclear(uint16_t color);
|
||||
|
||||
/************************************************************************************
|
||||
* Relay control functions
|
||||
*
|
||||
* Description:
|
||||
* Non-standard fucntions for relay control from the Shenzhou board.
|
||||
*
|
||||
************************************************************************************/
|
||||
|
||||
#ifdef CONFIG_ARCH_RELAYS
|
||||
EXTERN void up_relaysinit(void);
|
||||
EXTERN void relays_setstat(int relays,bool stat);
|
||||
EXTERN bool relays_getstat(int relays);
|
||||
EXTERN void relays_setstats(uint32_t relays_stat);
|
||||
EXTERN uint32_t relays_getstats(void);
|
||||
EXTERN void relays_onoff(int relays,uint32_t mdelay);
|
||||
EXTERN void relays_onoffs(uint32_t relays_stat,uint32_t mdelay);
|
||||
EXTERN void relays_resetmode(int relays);
|
||||
EXTERN void relays_powermode(int relays);
|
||||
EXTERN void relays_resetmodes(uint32_t relays_stat);
|
||||
EXTERN void relays_powermodes(uint32_t relays_stat);
|
||||
#endif
|
||||
|
||||
#undef EXTERN
|
||||
#if defined(__cplusplus)
|
||||
}
|
||||
|
|
|
|||
|
|
@ -56,6 +56,10 @@ ifeq ($(CONFIG_ARCH_BUTTONS),y)
|
|||
CSRCS += up_buttons.c
|
||||
endif
|
||||
|
||||
ifeq ($(CONFIG_ARCH_RELAYS),y)
|
||||
CSRCS += up_relays.c
|
||||
endif
|
||||
|
||||
ifeq ($(CONFIG_STM32_OTGFS),y)
|
||||
CSRCS += up_usb.c
|
||||
endif
|
||||
|
|
|
|||
|
|
@ -387,10 +387,16 @@
|
|||
* 58 PD11 SD_CS Active low: Pulled high (See also TFT LCD CN13, pin 32)
|
||||
*/
|
||||
|
||||
#define GPIO_SD_CD (GPIO_INPUT|GPIO_CNF_INFLOAT|GPIO_EXTI|GPIO_PORTB|GPIO_PIN14)
|
||||
#define GPIO_SD_CS (GPIO_OUTPUT|GPIO_CNF_OUTPP|GPIO_MODE_50MHz|\
|
||||
#define GPIO_SD_CD (GPIO_INPUT|GPIO_CNF_INFLOAT|GPIO_EXTI|GPIO_PORTB|GPIO_PIN14)
|
||||
#define GPIO_SD_CS (GPIO_OUTPUT|GPIO_CNF_OUTPP|GPIO_MODE_50MHz|\
|
||||
GPIO_OUTPUT_SET|GPIO_PORTD|GPIO_PIN11)
|
||||
|
||||
/* Relays */
|
||||
|
||||
#define NUM_RELAYS 1
|
||||
#define GPIO_RELAYS_R00 (GPIO_OUTPUT|GPIO_CNF_OUTPP|GPIO_MODE_50MHz|\
|
||||
GPIO_OUTPUT_SET|GPIO_PORTE|GPIO_PIN0)
|
||||
|
||||
/****************************************************************************************************
|
||||
* Public Types
|
||||
****************************************************************************************************/
|
||||
|
|
|
|||
|
|
@ -0,0 +1,276 @@
|
|||
/****************************************************************************
|
||||
* configs/shenzhou/src/up_relays.c
|
||||
*
|
||||
* Copyright (C) 2012 Gregory Nutt. All rights reserved.
|
||||
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||
* Darcy Gong
|
||||
*
|
||||
* 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 <unistd.h>
|
||||
|
||||
#include <arch/board/board.h>
|
||||
#include "shenzhou-internal.h"
|
||||
#include <debug.h>
|
||||
|
||||
#ifdef CONFIG_ARCH_RELAYS
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
****************************************************************************/
|
||||
|
||||
#define RELAYS_MIN_RESET_TIME 5
|
||||
#define RELAYS_RESET_MTIME 5
|
||||
#define RELAYS_POWER_MTIME 50
|
||||
|
||||
/****************************************************************************
|
||||
* Private Data
|
||||
****************************************************************************/
|
||||
|
||||
static uint32_t g_relays_stat = 0;
|
||||
|
||||
static const uint16_t g_relays[NUM_RELAYS] =
|
||||
{
|
||||
GPIO_RELAYS_R00
|
||||
#ifdef GPIO_RELAYS_R01
|
||||
, GPIO_RELAYS_R01
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R02
|
||||
, GPIO_RELAYS_R02
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R03
|
||||
, GPIO_RELAYS_R03
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R04
|
||||
, GPIO_RELAYS_R04
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R05
|
||||
, GPIO_RELAYS_R05
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R06
|
||||
, GPIO_RELAYS_R06
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R07
|
||||
, GPIO_RELAYS_R07
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R08
|
||||
, GPIO_RELAYS_R08
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R09
|
||||
, GPIO_RELAYS_R09
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R10
|
||||
, GPIO_RELAYS_R10
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R11
|
||||
, GPIO_RELAYS_R11
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R12
|
||||
, GPIO_RELAYS_R12
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R13
|
||||
, GPIO_RELAYS_R13
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R14
|
||||
, GPIO_RELAYS_R14
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R15
|
||||
, GPIO_RELAYS_R15
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R16
|
||||
, GPIO_RELAYS_R16
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R17
|
||||
, GPIO_RELAYS_R17
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R18
|
||||
, GPIO_RELAYS_R18
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R19
|
||||
, GPIO_RELAYS_R19
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R20
|
||||
, GPIO_RELAYS_R20
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R21
|
||||
, GPIO_RELAYS_R21
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R22
|
||||
, GPIO_RELAYS_R22
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R23
|
||||
, GPIO_RELAYS_R23
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R24
|
||||
, GPIO_RELAYS_R24
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R25
|
||||
, GPIO_RELAYS_R25
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R26
|
||||
, GPIO_RELAYS_R26
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R27
|
||||
, GPIO_RELAYS_R27
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R28
|
||||
, GPIO_RELAYS_R28
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R29
|
||||
, GPIO_RELAYS_R29
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R30
|
||||
, GPIO_RELAYS_R30
|
||||
#endif
|
||||
#ifdef GPIO_RELAYS_R31
|
||||
, GPIO_RELAYS_R31
|
||||
#endif
|
||||
};
|
||||
|
||||
/****************************************************************************
|
||||
* Private Functions
|
||||
****************************************************************************/
|
||||
|
||||
/****************************************************************************
|
||||
* Public Functions
|
||||
****************************************************************************/
|
||||
|
||||
void up_relaysinit(void)
|
||||
{
|
||||
int i;
|
||||
|
||||
/* Configure the GPIO pins as inputs. NOTE that EXTI interrupts are
|
||||
* configured for some pins but NOT used in this file
|
||||
*/
|
||||
|
||||
for (i = 0; i < NUM_RELAYS; i++)
|
||||
{
|
||||
stm32_configgpio(g_relays[i]);
|
||||
}
|
||||
}
|
||||
|
||||
void relays_setstat(int relays,bool stat)
|
||||
{
|
||||
if ((unsigned)relays < NUM_RELAYS)
|
||||
{
|
||||
stm32_gpiowrite(g_relays[relays], stat);
|
||||
if (!stat)
|
||||
{
|
||||
g_relays_stat &= ~(1 << relays);
|
||||
}
|
||||
else
|
||||
{
|
||||
g_relays_stat |= (1 << relays);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
bool relays_getstat(int relays)
|
||||
{
|
||||
if ((unsigned)relays < NUM_RELAYS)
|
||||
{
|
||||
return (g_relays_stat & (1 << relays)) != 0;
|
||||
}
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
void relays_setstats(uint32_t relays_stat)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < NUM_RELAYS; i++)
|
||||
{
|
||||
relays_setstat(i, (relays_stat & (1<<i))!=0);
|
||||
}
|
||||
}
|
||||
|
||||
uint32_t relays_getstats(void)
|
||||
{
|
||||
return (uint32_t)g_relays_stat;
|
||||
}
|
||||
|
||||
void relays_onoff(int relays, uint32_t mdelay)
|
||||
{
|
||||
if ((unsigned)relays < NUM_RELAYS)
|
||||
{
|
||||
if (mdelay>0)
|
||||
{
|
||||
if (relays_getstat(relays))
|
||||
{
|
||||
relays_setstat(relays, false);
|
||||
usleep(RELAYS_MIN_RESET_TIME*1000*1000);
|
||||
}
|
||||
|
||||
relays_setstat(relays,true);
|
||||
usleep(mdelay*100*1000);
|
||||
relays_setstat(relays, false);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void relays_onoffs(uint32_t relays_stat, uint32_t mdelay)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < NUM_RELAYS; i++)
|
||||
{
|
||||
relays_onoff(i, mdelay);
|
||||
}
|
||||
}
|
||||
|
||||
void relays_resetmode(int relays)
|
||||
{
|
||||
relays_onoff(relays, RELAYS_RESET_MTIME);
|
||||
}
|
||||
|
||||
void relays_powermode(int relays)
|
||||
{
|
||||
relays_onoff(relays, RELAYS_POWER_MTIME);
|
||||
}
|
||||
|
||||
void relays_resetmodes(uint32_t relays_stat)
|
||||
{
|
||||
relays_onoffs(relays_stat, RELAYS_RESET_MTIME);
|
||||
}
|
||||
|
||||
void relays_powermodes(uint32_t relays_stat)
|
||||
{
|
||||
relays_onoffs(relays_stat, RELAYS_POWER_MTIME);
|
||||
}
|
||||
|
||||
#endif /* CONFIG_ARCH_BUTTONS */
|
||||
|
|
@ -1007,7 +1007,12 @@ Where <subdir> is one of the following:
|
|||
3. By default, this project assumes that you are *NOT* using the DFU
|
||||
bootloader.
|
||||
|
||||
4. This configuration requires that you have the genromfs tool installed
|
||||
4. It appears that you cannot excute from CCM RAM. This is why the
|
||||
following definition appears in the defconfig file:
|
||||
|
||||
CONFIG_STM32_CCMEXCLUDE=y
|
||||
|
||||
5. This configuration requires that you have the genromfs tool installed
|
||||
on your system and that you have the full path to the installed genromfs
|
||||
executable in PATH variable (see apps/examples/README.txt)
|
||||
|
||||
|
|
|
|||
Loading…
Reference in New Issue