2010-06-13 06:23:44 +02:00
|
|
|
/**
|
|
|
|
******************************************************************************
|
2010-07-28 09:28:21 +02:00
|
|
|
* @addtogroup OpenPilotSystem OpenPilot System
|
|
|
|
* @{
|
|
|
|
* @addtogroup OpenPilotCore OpenPilot Core
|
|
|
|
* @{
|
2010-06-13 06:23:44 +02:00
|
|
|
*
|
|
|
|
* @file pios_board.c
|
|
|
|
* @author The OpenPilot Team, http://www.openpilot.org Copyright (C) 2010.
|
|
|
|
* @brief Defines board specific static initializers for hardware for the OpenPilot board.
|
|
|
|
* @see The GNU Public License (GPL) Version 3
|
|
|
|
*
|
|
|
|
*****************************************************************************/
|
|
|
|
/*
|
|
|
|
* This program is free software; you can redistribute it and/or modify
|
|
|
|
* it under the terms of the GNU General Public License as published by
|
|
|
|
* the Free Software Foundation; either version 3 of the License, or
|
|
|
|
* (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program is distributed in the hope that it will be useful, but
|
|
|
|
* WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
|
|
|
|
* or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
|
|
|
* for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU General Public License along
|
|
|
|
* with this program; if not, write to the Free Software Foundation, Inc.,
|
|
|
|
* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <pios.h>
|
2010-07-13 18:23:41 +02:00
|
|
|
#include <openpilot.h>
|
|
|
|
#include <uavobjectsinit.h>
|
2011-07-30 21:04:24 +02:00
|
|
|
#include <hwsettings.h>
|
2011-09-28 21:02:02 +02:00
|
|
|
#include <manualcontrolsettings.h>
|
2010-07-13 18:23:41 +02:00
|
|
|
|
2011-03-05 10:21:32 +01:00
|
|
|
//#define I2C_DEBUG_PIN 0
|
|
|
|
//#define USART_GPS_DEBUG_PIN 1
|
|
|
|
|
2011-02-12 23:19:50 +01:00
|
|
|
#if defined(PIOS_INCLUDE_SPI)
|
|
|
|
|
|
|
|
#include <pios_spi_priv.h>
|
|
|
|
|
2010-06-13 06:23:44 +02:00
|
|
|
/* MicroSD Interface
|
|
|
|
*
|
2010-07-04 04:21:13 +02:00
|
|
|
* NOTE: Leave this declared as const data so that it ends up in the
|
2010-06-13 06:23:44 +02:00
|
|
|
* .rodata section (ie. Flash) rather than in the .bss section (RAM).
|
|
|
|
*/
|
|
|
|
void PIOS_SPI_sdcard_irq_handler(void);
|
2010-07-04 04:21:13 +02:00
|
|
|
void DMA1_Channel2_IRQHandler() __attribute__ ((alias ("PIOS_SPI_sdcard_irq_handler")));
|
|
|
|
void DMA1_Channel3_IRQHandler() __attribute__ ((alias ("PIOS_SPI_sdcard_irq_handler")));
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_spi_cfg pios_spi_sdcard_cfg = {
|
2010-06-13 06:23:44 +02:00
|
|
|
.regs = SPI1,
|
|
|
|
.init = {
|
|
|
|
.SPI_Mode = SPI_Mode_Master,
|
|
|
|
.SPI_Direction = SPI_Direction_2Lines_FullDuplex,
|
|
|
|
.SPI_DataSize = SPI_DataSize_8b,
|
|
|
|
.SPI_NSS = SPI_NSS_Soft,
|
|
|
|
.SPI_FirstBit = SPI_FirstBit_MSB,
|
|
|
|
.SPI_CRCPolynomial = 7,
|
|
|
|
.SPI_CPOL = SPI_CPOL_High,
|
|
|
|
.SPI_CPHA = SPI_CPHA_2Edge,
|
2011-01-05 11:34:42 +01:00
|
|
|
.SPI_BaudRatePrescaler = SPI_BaudRatePrescaler_256, /* Maximum divider (ie. slowest clock rate) */
|
2010-06-13 06:23:44 +02:00
|
|
|
},
|
|
|
|
.dma = {
|
|
|
|
.ahb_clk = RCC_AHBPeriph_DMA1,
|
|
|
|
|
|
|
|
.irq = {
|
|
|
|
.flags = (DMA1_FLAG_TC2 | DMA1_FLAG_TE2 | DMA1_FLAG_HT2 | DMA1_FLAG_GL2),
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = DMA1_Channel2_IRQn,
|
2011-01-09 21:49:29 +01:00
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
2010-06-13 06:23:44 +02:00
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
|
|
|
|
.rx = {
|
|
|
|
.channel = DMA1_Channel2,
|
|
|
|
.init = {
|
|
|
|
.DMA_PeripheralBaseAddr = (uint32_t)&(SPI1->DR),
|
|
|
|
.DMA_DIR = DMA_DIR_PeripheralSRC,
|
|
|
|
.DMA_PeripheralInc = DMA_PeripheralInc_Disable,
|
|
|
|
.DMA_MemoryInc = DMA_MemoryInc_Enable,
|
|
|
|
.DMA_PeripheralDataSize = DMA_PeripheralDataSize_Byte,
|
|
|
|
.DMA_MemoryDataSize = DMA_MemoryDataSize_Byte,
|
|
|
|
.DMA_Mode = DMA_Mode_Normal,
|
|
|
|
.DMA_Priority = DMA_Priority_Medium,
|
|
|
|
.DMA_M2M = DMA_M2M_Disable,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.tx = {
|
|
|
|
.channel = DMA1_Channel3,
|
|
|
|
.init = {
|
|
|
|
.DMA_PeripheralBaseAddr = (uint32_t)&(SPI1->DR),
|
|
|
|
.DMA_DIR = DMA_DIR_PeripheralDST,
|
|
|
|
.DMA_PeripheralInc = DMA_PeripheralInc_Disable,
|
|
|
|
.DMA_MemoryInc = DMA_MemoryInc_Enable,
|
|
|
|
.DMA_PeripheralDataSize = DMA_PeripheralDataSize_Byte,
|
|
|
|
.DMA_MemoryDataSize = DMA_MemoryDataSize_Byte,
|
|
|
|
.DMA_Mode = DMA_Mode_Normal,
|
|
|
|
.DMA_Priority = DMA_Priority_Medium,
|
|
|
|
.DMA_M2M = DMA_M2M_Disable,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.ssel = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_4,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.sclk = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_5,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.miso = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_6,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPU,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.mosi = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_7,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
/* AHRS Interface
|
|
|
|
*
|
2010-07-04 04:21:13 +02:00
|
|
|
* NOTE: Leave this declared as const data so that it ends up in the
|
2010-06-13 06:23:44 +02:00
|
|
|
* .rodata section (ie. Flash) rather than in the .bss section (RAM).
|
|
|
|
*/
|
|
|
|
void PIOS_SPI_ahrs_irq_handler(void);
|
2010-07-04 04:21:13 +02:00
|
|
|
void DMA1_Channel4_IRQHandler() __attribute__ ((alias ("PIOS_SPI_ahrs_irq_handler")));
|
|
|
|
void DMA1_Channel5_IRQHandler() __attribute__ ((alias ("PIOS_SPI_ahrs_irq_handler")));
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_spi_cfg pios_spi_ahrs_cfg = {
|
2010-06-13 06:23:44 +02:00
|
|
|
.regs = SPI2,
|
|
|
|
.init = {
|
|
|
|
.SPI_Mode = SPI_Mode_Master,
|
|
|
|
.SPI_Direction = SPI_Direction_2Lines_FullDuplex,
|
|
|
|
.SPI_DataSize = SPI_DataSize_8b,
|
|
|
|
.SPI_NSS = SPI_NSS_Soft,
|
|
|
|
.SPI_FirstBit = SPI_FirstBit_MSB,
|
|
|
|
.SPI_CRCPolynomial = 7,
|
|
|
|
.SPI_CPOL = SPI_CPOL_High,
|
|
|
|
.SPI_CPHA = SPI_CPHA_2Edge,
|
2011-01-05 11:34:42 +01:00
|
|
|
.SPI_BaudRatePrescaler = SPI_BaudRatePrescaler_16,
|
2010-06-13 06:23:44 +02:00
|
|
|
},
|
2010-07-04 04:21:42 +02:00
|
|
|
.use_crc = TRUE,
|
2010-06-13 06:23:44 +02:00
|
|
|
.dma = {
|
|
|
|
.ahb_clk = RCC_AHBPeriph_DMA1,
|
|
|
|
|
|
|
|
.irq = {
|
|
|
|
.flags = (DMA1_FLAG_TC4 | DMA1_FLAG_TE4 | DMA1_FLAG_HT4 | DMA1_FLAG_GL4),
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = DMA1_Channel4_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_HIGH,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
|
|
|
|
.rx = {
|
|
|
|
.channel = DMA1_Channel4,
|
|
|
|
.init = {
|
|
|
|
.DMA_PeripheralBaseAddr = (uint32_t)&(SPI2->DR),
|
|
|
|
.DMA_DIR = DMA_DIR_PeripheralSRC,
|
|
|
|
.DMA_PeripheralInc = DMA_PeripheralInc_Disable,
|
|
|
|
.DMA_MemoryInc = DMA_MemoryInc_Enable,
|
|
|
|
.DMA_PeripheralDataSize = DMA_PeripheralDataSize_Byte,
|
|
|
|
.DMA_MemoryDataSize = DMA_MemoryDataSize_Byte,
|
|
|
|
.DMA_Mode = DMA_Mode_Normal,
|
2011-01-09 21:49:29 +01:00
|
|
|
.DMA_Priority = DMA_Priority_High,
|
2010-06-13 06:23:44 +02:00
|
|
|
.DMA_M2M = DMA_M2M_Disable,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.tx = {
|
|
|
|
.channel = DMA1_Channel5,
|
|
|
|
.init = {
|
|
|
|
.DMA_PeripheralBaseAddr = (uint32_t)&(SPI2->DR),
|
|
|
|
.DMA_DIR = DMA_DIR_PeripheralDST,
|
|
|
|
.DMA_PeripheralInc = DMA_PeripheralInc_Disable,
|
|
|
|
.DMA_MemoryInc = DMA_MemoryInc_Enable,
|
|
|
|
.DMA_PeripheralDataSize = DMA_PeripheralDataSize_Byte,
|
|
|
|
.DMA_MemoryDataSize = DMA_MemoryDataSize_Byte,
|
|
|
|
.DMA_Mode = DMA_Mode_Normal,
|
2011-01-09 21:49:29 +01:00
|
|
|
.DMA_Priority = DMA_Priority_High,
|
2010-06-13 06:23:44 +02:00
|
|
|
.DMA_M2M = DMA_M2M_Disable,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.ssel = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_12,
|
2011-01-09 21:49:46 +01:00
|
|
|
.GPIO_Speed = GPIO_Speed_10MHz,
|
2010-06-13 06:23:44 +02:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.sclk = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_13,
|
2011-01-09 21:49:46 +01:00
|
|
|
.GPIO_Speed = GPIO_Speed_10MHz,
|
2010-06-13 06:23:44 +02:00
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.miso = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_14,
|
2011-01-09 21:49:46 +01:00
|
|
|
.GPIO_Speed = GPIO_Speed_10MHz,
|
2010-07-04 04:21:26 +02:00
|
|
|
.GPIO_Mode = GPIO_Mode_IN_FLOATING,
|
2010-06-13 06:23:44 +02:00
|
|
|
},
|
|
|
|
},
|
|
|
|
.mosi = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_15,
|
2011-01-09 21:49:46 +01:00
|
|
|
.GPIO_Speed = GPIO_Speed_10MHz,
|
2010-06-13 06:23:44 +02:00
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
2011-02-12 23:19:50 +01:00
|
|
|
static uint32_t pios_spi_sdcard_id;
|
2010-06-13 06:23:44 +02:00
|
|
|
void PIOS_SPI_sdcard_irq_handler(void)
|
|
|
|
{
|
|
|
|
/* Call into the generic code to handle the IRQ for this specific device */
|
2011-02-12 23:19:50 +01:00
|
|
|
PIOS_SPI_IRQ_Handler(pios_spi_sdcard_id);
|
2010-06-13 06:23:44 +02:00
|
|
|
}
|
|
|
|
|
2011-02-12 23:19:50 +01:00
|
|
|
uint32_t pios_spi_ahrs_id;
|
2010-06-13 06:23:44 +02:00
|
|
|
void PIOS_SPI_ahrs_irq_handler(void)
|
|
|
|
{
|
|
|
|
/* Call into the generic code to handle the IRQ for this specific device */
|
2011-02-12 23:19:50 +01:00
|
|
|
PIOS_SPI_IRQ_Handler(pios_spi_ahrs_id);
|
2010-06-13 06:23:44 +02:00
|
|
|
}
|
2010-06-13 06:24:26 +02:00
|
|
|
|
2011-02-12 23:19:50 +01:00
|
|
|
#endif /* PIOS_INCLUDE_SPI */
|
|
|
|
|
2011-01-16 03:45:39 +01:00
|
|
|
/*
|
|
|
|
* ADC system
|
|
|
|
*/
|
|
|
|
#include "pios_adc_priv.h"
|
|
|
|
extern void PIOS_ADC_handler(void);
|
|
|
|
void DMA1_Channel1_IRQHandler() __attribute__ ((alias("PIOS_ADC_handler")));
|
|
|
|
// Remap the ADC DMA handler to this one
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_adc_cfg pios_adc_cfg = {
|
2011-01-16 03:45:39 +01:00
|
|
|
.dma = {
|
|
|
|
.ahb_clk = RCC_AHBPeriph_DMA1,
|
|
|
|
.irq = {
|
|
|
|
.flags = (DMA1_FLAG_TC1 | DMA1_FLAG_TE1 | DMA1_FLAG_HT1 | DMA1_FLAG_GL1),
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = DMA1_Channel1_IRQn,
|
2011-01-17 00:00:48 +01:00
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_LOW,
|
2011-01-16 03:45:39 +01:00
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.rx = {
|
|
|
|
.channel = DMA1_Channel1,
|
|
|
|
.init = {
|
|
|
|
.DMA_PeripheralBaseAddr = (uint32_t) & ADC1->DR,
|
|
|
|
.DMA_DIR = DMA_DIR_PeripheralSRC,
|
|
|
|
.DMA_PeripheralInc = DMA_PeripheralInc_Disable,
|
|
|
|
.DMA_MemoryInc = DMA_MemoryInc_Enable,
|
|
|
|
.DMA_PeripheralDataSize = DMA_PeripheralDataSize_Word,
|
|
|
|
.DMA_MemoryDataSize = DMA_MemoryDataSize_Word,
|
|
|
|
.DMA_Mode = DMA_Mode_Circular,
|
2011-01-17 00:00:48 +01:00
|
|
|
.DMA_Priority = DMA_Priority_Low,
|
2011-01-16 03:45:39 +01:00
|
|
|
.DMA_M2M = DMA_M2M_Disable,
|
|
|
|
},
|
|
|
|
}
|
|
|
|
},
|
|
|
|
.half_flag = DMA1_IT_HT1,
|
|
|
|
.full_flag = DMA1_IT_TC1,
|
|
|
|
};
|
|
|
|
|
|
|
|
struct pios_adc_dev pios_adc_devs[] = {
|
|
|
|
{
|
|
|
|
.cfg = &pios_adc_cfg,
|
|
|
|
.callback_function = NULL,
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
uint8_t pios_adc_num_devices = NELEMENTS(pios_adc_devs);
|
|
|
|
|
|
|
|
void PIOS_ADC_handler() {
|
|
|
|
PIOS_ADC_DMA_Handler();
|
|
|
|
}
|
|
|
|
|
2011-08-13 05:23:16 +02:00
|
|
|
#include "pios_tim_priv.h"
|
|
|
|
|
|
|
|
static const TIM_TimeBaseInitTypeDef tim_4_8_time_base = {
|
|
|
|
.TIM_Prescaler = (PIOS_MASTER_CLOCK / 1000000) - 1,
|
|
|
|
.TIM_ClockDivision = TIM_CKD_DIV1,
|
|
|
|
.TIM_CounterMode = TIM_CounterMode_Up,
|
|
|
|
.TIM_Period = ((1000000 / PIOS_SERVO_UPDATE_HZ) - 1),
|
|
|
|
.TIM_RepetitionCounter = 0x0000,
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct pios_tim_clock_cfg tim_4_cfg = {
|
|
|
|
.timer = TIM4,
|
|
|
|
.time_base_init = &tim_4_8_time_base,
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = TIM4_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct pios_tim_clock_cfg tim_8_cfg = {
|
|
|
|
.timer = TIM8,
|
|
|
|
.time_base_init = &tim_4_8_time_base,
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = TIM8_CC_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static const TIM_TimeBaseInitTypeDef tim_1_3_5_time_base = {
|
|
|
|
.TIM_Prescaler = (PIOS_MASTER_CLOCK / 1000000) - 1,
|
|
|
|
.TIM_ClockDivision = TIM_CKD_DIV1,
|
|
|
|
.TIM_CounterMode = TIM_CounterMode_Up,
|
|
|
|
.TIM_Period = 0xFFFF,
|
|
|
|
.TIM_RepetitionCounter = 0x0000,
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct pios_tim_clock_cfg tim_1_cfg = {
|
|
|
|
.timer = TIM1,
|
|
|
|
.time_base_init = &tim_1_3_5_time_base,
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = TIM1_CC_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct pios_tim_clock_cfg tim_3_cfg = {
|
|
|
|
.timer = TIM3,
|
|
|
|
.time_base_init = &tim_1_3_5_time_base,
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = TIM3_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct pios_tim_clock_cfg tim_5_cfg = {
|
|
|
|
.timer = TIM5,
|
|
|
|
.time_base_init = &tim_1_3_5_time_base,
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = TIM5_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
2011-02-12 23:19:43 +01:00
|
|
|
#if defined(PIOS_INCLUDE_USART)
|
|
|
|
|
|
|
|
#include "pios_usart_priv.h"
|
2011-01-16 03:45:39 +01:00
|
|
|
|
2010-06-13 06:24:26 +02:00
|
|
|
/*
|
|
|
|
* Telemetry USART
|
|
|
|
*/
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_usart_cfg pios_usart_telem_cfg = {
|
2010-06-13 06:24:26 +02:00
|
|
|
.regs = USART2,
|
|
|
|
.init = {
|
2011-07-07 05:03:54 +02:00
|
|
|
.USART_BaudRate = 57600,
|
2010-06-13 06:24:26 +02:00
|
|
|
.USART_WordLength = USART_WordLength_8b,
|
|
|
|
.USART_Parity = USART_Parity_No,
|
|
|
|
.USART_StopBits = USART_StopBits_1,
|
|
|
|
.USART_HardwareFlowControl = USART_HardwareFlowControl_None,
|
|
|
|
.USART_Mode = USART_Mode_Rx | USART_Mode_Tx,
|
|
|
|
},
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = USART2_IRQn,
|
2011-01-09 21:49:26 +01:00
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
2010-06-13 06:24:26 +02:00
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.rx = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_3,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPU,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.tx = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_2,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
/*
|
|
|
|
* GPS USART
|
|
|
|
*/
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_usart_cfg pios_usart_gps_cfg = {
|
2010-06-13 06:24:26 +02:00
|
|
|
.regs = USART3,
|
|
|
|
.remap = GPIO_PartialRemap_USART3,
|
|
|
|
.init = {
|
2011-07-07 05:03:54 +02:00
|
|
|
.USART_BaudRate = 57600,
|
2010-06-13 06:24:26 +02:00
|
|
|
.USART_WordLength = USART_WordLength_8b,
|
|
|
|
.USART_Parity = USART_Parity_No,
|
|
|
|
.USART_StopBits = USART_StopBits_1,
|
|
|
|
.USART_HardwareFlowControl = USART_HardwareFlowControl_None,
|
|
|
|
.USART_Mode = USART_Mode_Rx | USART_Mode_Tx,
|
|
|
|
},
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = USART3_IRQn,
|
2011-01-09 21:49:26 +01:00
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
2010-06-13 06:24:26 +02:00
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.rx = {
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_11,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPU,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.tx = {
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_10,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
#ifdef PIOS_COM_AUX
|
|
|
|
/*
|
|
|
|
* AUX USART
|
|
|
|
*/
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_usart_cfg pios_usart_aux_cfg = {
|
2010-06-13 06:24:26 +02:00
|
|
|
.regs = USART1,
|
|
|
|
.init = {
|
|
|
|
.USART_BaudRate = 57600,
|
|
|
|
.USART_WordLength = USART_WordLength_8b,
|
|
|
|
.USART_Parity = USART_Parity_No,
|
|
|
|
.USART_StopBits = USART_StopBits_1,
|
|
|
|
.USART_HardwareFlowControl = USART_HardwareFlowControl_None,
|
|
|
|
.USART_Mode = USART_Mode_Rx | USART_Mode_Tx,
|
|
|
|
},
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = USART1_IRQn,
|
2011-01-09 21:49:26 +01:00
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
2010-06-13 06:24:26 +02:00
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
2010-06-20 19:48:59 +02:00
|
|
|
.remap = GPIO_Remap_USART1,
|
2010-06-13 06:24:26 +02:00
|
|
|
.rx = {
|
2010-06-20 19:48:59 +02:00
|
|
|
.gpio = GPIOB,
|
2010-06-13 06:24:26 +02:00
|
|
|
.init = {
|
2010-06-20 19:48:59 +02:00
|
|
|
.GPIO_Pin = GPIO_Pin_7,
|
2010-06-13 06:24:26 +02:00
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPU,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.tx = {
|
2010-06-20 19:48:59 +02:00
|
|
|
.gpio = GPIOB,
|
2010-06-13 06:24:26 +02:00
|
|
|
.init = {
|
2010-06-20 19:48:59 +02:00
|
|
|
.GPIO_Pin = GPIO_Pin_6,
|
2010-06-13 06:24:26 +02:00
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
#endif
|
|
|
|
|
2011-07-03 01:25:35 +02:00
|
|
|
#if defined(PIOS_INCLUDE_RTC)
|
|
|
|
/*
|
|
|
|
* Realtime Clock (RTC)
|
|
|
|
*/
|
|
|
|
#include <pios_rtc_priv.h>
|
|
|
|
|
|
|
|
void PIOS_RTC_IRQ_Handler (void);
|
|
|
|
void RTC_IRQHandler() __attribute__ ((alias ("PIOS_RTC_IRQ_Handler")));
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_rtc_cfg pios_rtc_main_cfg = {
|
2011-07-03 01:25:35 +02:00
|
|
|
.clksrc = RCC_RTCCLKSource_HSE_Div128,
|
|
|
|
.prescaler = 100,
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = RTC_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_MID,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
void PIOS_RTC_IRQ_Handler (void)
|
|
|
|
{
|
|
|
|
PIOS_RTC_irq_handler ();
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
2011-11-04 20:40:34 +01:00
|
|
|
#if defined(PIOS_INCLUDE_DSM)
|
2010-08-01 12:34:07 +02:00
|
|
|
/*
|
2011-11-04 20:40:34 +01:00
|
|
|
* Spektrum/JR DSM USART
|
2010-08-01 12:34:07 +02:00
|
|
|
*/
|
2011-11-04 20:40:34 +01:00
|
|
|
#include <pios_dsm_priv.h>
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
|
2011-11-04 20:40:34 +01:00
|
|
|
static const struct pios_usart_cfg pios_usart_dsm_cfg = {
|
2011-02-12 23:19:43 +01:00
|
|
|
.regs = USART1,
|
|
|
|
.init = {
|
2011-07-07 05:03:54 +02:00
|
|
|
.USART_BaudRate = 115200,
|
2011-02-12 23:19:43 +01:00
|
|
|
.USART_WordLength = USART_WordLength_8b,
|
|
|
|
.USART_Parity = USART_Parity_No,
|
|
|
|
.USART_StopBits = USART_StopBits_1,
|
|
|
|
.USART_HardwareFlowControl = USART_HardwareFlowControl_None,
|
|
|
|
.USART_Mode = USART_Mode_Rx,
|
|
|
|
},
|
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = USART1_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_HIGH,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.rx = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_10,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPU,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.tx = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_9,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IN_FLOATING,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
2011-11-04 20:40:34 +01:00
|
|
|
static const struct pios_dsm_cfg pios_dsm_cfg = {
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
.bind = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_10,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
|
|
|
},
|
2011-01-28 10:25:30 +01:00
|
|
|
},
|
2010-08-01 12:34:07 +02:00
|
|
|
};
|
2011-01-28 10:25:30 +01:00
|
|
|
|
2011-11-04 20:40:34 +01:00
|
|
|
#endif /* PIOS_COM_DSM */
|
2010-06-13 06:24:26 +02:00
|
|
|
|
2011-06-13 02:04:49 +02:00
|
|
|
#if defined(PIOS_INCLUDE_SBUS)
|
|
|
|
#error PIOS_INCLUDE_SBUS not implemented
|
|
|
|
#endif /* PIOS_INCLUDE_SBUS */
|
|
|
|
|
2011-02-12 23:19:43 +01:00
|
|
|
#endif /* PIOS_INCLUDE_USART */
|
|
|
|
|
|
|
|
#if defined(PIOS_INCLUDE_COM)
|
|
|
|
|
|
|
|
#include "pios_com_priv.h"
|
|
|
|
|
2011-07-29 16:04:55 +02:00
|
|
|
#define PIOS_COM_TELEM_RF_RX_BUF_LEN 192
|
|
|
|
#define PIOS_COM_TELEM_RF_TX_BUF_LEN 192
|
|
|
|
|
|
|
|
#define PIOS_COM_GPS_RX_BUF_LEN 96
|
|
|
|
|
|
|
|
#define PIOS_COM_TELEM_USB_RX_BUF_LEN 192
|
|
|
|
#define PIOS_COM_TELEM_USB_TX_BUF_LEN 192
|
|
|
|
|
2011-02-12 23:19:43 +01:00
|
|
|
#endif /* PIOS_INCLUDE_COM */
|
2010-08-01 12:34:07 +02:00
|
|
|
|
2011-01-21 04:40:21 +01:00
|
|
|
/**
|
|
|
|
* Pios servo configuration structures
|
|
|
|
*/
|
|
|
|
#include <pios_servo_priv.h>
|
2011-08-13 05:23:16 +02:00
|
|
|
static const struct pios_tim_channel pios_tim_servoport_all_pins[] = {
|
2011-01-21 04:40:21 +01:00
|
|
|
{
|
|
|
|
.timer = TIM4,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_1,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_6,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-21 04:40:21 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM4,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_2,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_7,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-21 04:40:21 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM4,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_3,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_8,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-21 04:40:21 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM4,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_4,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_9,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-21 04:40:21 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM8,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_1,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_6,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-21 04:40:21 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM8,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_2,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_7,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-21 04:40:21 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM8,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_3,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_8,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-21 04:40:21 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM8,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_4,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_9,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_PP,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-21 04:40:21 +01:00
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
const struct pios_servo_cfg pios_servo_cfg = {
|
|
|
|
.tim_oc_init = {
|
|
|
|
.TIM_OCMode = TIM_OCMode_PWM1,
|
|
|
|
.TIM_OutputState = TIM_OutputState_Enable,
|
|
|
|
.TIM_OutputNState = TIM_OutputNState_Disable,
|
|
|
|
.TIM_Pulse = PIOS_SERVOS_INITIAL_POSITION,
|
|
|
|
.TIM_OCPolarity = TIM_OCPolarity_High,
|
|
|
|
.TIM_OCNPolarity = TIM_OCPolarity_High,
|
|
|
|
.TIM_OCIdleState = TIM_OCIdleState_Reset,
|
|
|
|
.TIM_OCNIdleState = TIM_OCNIdleState_Reset,
|
|
|
|
},
|
2011-08-13 05:23:16 +02:00
|
|
|
.channels = pios_tim_servoport_all_pins,
|
|
|
|
.num_channels = NELEMENTS(pios_tim_servoport_all_pins),
|
2011-01-21 04:40:21 +01:00
|
|
|
};
|
|
|
|
|
|
|
|
|
2011-01-24 08:51:45 +01:00
|
|
|
/*
|
|
|
|
* PWM Inputs
|
|
|
|
*/
|
2011-09-10 20:11:21 +02:00
|
|
|
#if defined(PIOS_INCLUDE_PWM) || defined(PIOS_INCLUDE_PPM)
|
2011-01-24 08:51:45 +01:00
|
|
|
#include <pios_pwm_priv.h>
|
2011-08-13 05:23:16 +02:00
|
|
|
static const struct pios_tim_channel pios_tim_rcvrport_all_channels[] = {
|
2011-01-24 08:51:45 +01:00
|
|
|
{
|
|
|
|
.timer = TIM1,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_2,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_9,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPD,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
},
|
2011-01-24 08:51:45 +01:00
|
|
|
{
|
|
|
|
.timer = TIM1,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_3,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_10,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPD,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-24 08:51:45 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM5,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_1,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_0,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPD,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-24 08:51:45 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM1,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_1,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOA,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_8,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPD,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-24 08:51:45 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM3,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_4,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_1,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPD,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-24 08:51:45 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM3,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_3,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_0,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPD,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
2011-01-24 08:51:45 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM3,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_1,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_4,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPD,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.remap = GPIO_PartialRemap_TIM3,
|
2011-01-24 08:51:45 +01:00
|
|
|
},
|
|
|
|
{
|
|
|
|
.timer = TIM3,
|
2011-08-13 05:23:16 +02:00
|
|
|
.timer_chan = TIM_Channel_2,
|
|
|
|
.pin = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_5,
|
|
|
|
.GPIO_Mode = GPIO_Mode_IPD,
|
|
|
|
.GPIO_Speed = GPIO_Speed_2MHz,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.remap = GPIO_PartialRemap_TIM3,
|
2011-01-24 08:51:45 +01:00
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
const struct pios_pwm_cfg pios_pwm_cfg = {
|
|
|
|
.tim_ic_init = {
|
|
|
|
.TIM_ICPolarity = TIM_ICPolarity_Rising,
|
|
|
|
.TIM_ICSelection = TIM_ICSelection_DirectTI,
|
|
|
|
.TIM_ICPrescaler = TIM_ICPSC_DIV1,
|
|
|
|
.TIM_ICFilter = 0x0,
|
|
|
|
},
|
2011-08-13 05:23:16 +02:00
|
|
|
.channels = pios_tim_rcvrport_all_channels,
|
|
|
|
.num_channels = NELEMENTS(pios_tim_rcvrport_all_channels),
|
2011-01-24 08:51:45 +01:00
|
|
|
};
|
2011-01-25 00:17:39 +01:00
|
|
|
#endif
|
2011-01-24 08:51:45 +01:00
|
|
|
|
2011-03-08 19:08:13 +01:00
|
|
|
/*
|
|
|
|
* PPM Input
|
|
|
|
*/
|
|
|
|
#if defined(PIOS_INCLUDE_PPM)
|
|
|
|
#include <pios_ppm_priv.h>
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_ppm_cfg pios_ppm_cfg = {
|
2011-03-08 19:08:13 +01:00
|
|
|
.tim_ic_init = {
|
|
|
|
.TIM_ICPolarity = TIM_ICPolarity_Rising,
|
|
|
|
.TIM_ICSelection = TIM_ICSelection_DirectTI,
|
|
|
|
.TIM_ICPrescaler = TIM_ICPSC_DIV1,
|
|
|
|
.TIM_ICFilter = 0x0,
|
|
|
|
.TIM_Channel = TIM_Channel_2,
|
|
|
|
},
|
2011-08-13 05:23:16 +02:00
|
|
|
/* Use only the first channel for ppm */
|
|
|
|
.channels = &pios_tim_rcvrport_all_channels[0],
|
|
|
|
.num_channels = 1,
|
2011-03-08 19:08:13 +01:00
|
|
|
};
|
|
|
|
|
|
|
|
#endif //PPM
|
|
|
|
|
2011-02-12 23:19:54 +01:00
|
|
|
#if defined(PIOS_INCLUDE_I2C)
|
|
|
|
|
|
|
|
#include <pios_i2c_priv.h>
|
|
|
|
|
2010-08-08 06:15:08 +02:00
|
|
|
/*
|
|
|
|
* I2C Adapters
|
|
|
|
*/
|
|
|
|
|
|
|
|
void PIOS_I2C_main_adapter_ev_irq_handler(void);
|
|
|
|
void PIOS_I2C_main_adapter_er_irq_handler(void);
|
|
|
|
void I2C2_EV_IRQHandler() __attribute__ ((alias ("PIOS_I2C_main_adapter_ev_irq_handler")));
|
|
|
|
void I2C2_ER_IRQHandler() __attribute__ ((alias ("PIOS_I2C_main_adapter_er_irq_handler")));
|
|
|
|
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
static const struct pios_i2c_adapter_cfg pios_i2c_main_adapter_cfg = {
|
2010-08-08 06:15:08 +02:00
|
|
|
.regs = I2C2,
|
|
|
|
.init = {
|
|
|
|
.I2C_Mode = I2C_Mode_I2C,
|
|
|
|
.I2C_OwnAddress1 = 0,
|
|
|
|
.I2C_Ack = I2C_Ack_Enable,
|
|
|
|
.I2C_AcknowledgedAddress = I2C_AcknowledgedAddress_7bit,
|
|
|
|
.I2C_DutyCycle = I2C_DutyCycle_2,
|
|
|
|
.I2C_ClockSpeed = 400000, /* bits/s */
|
|
|
|
},
|
|
|
|
.transfer_timeout_ms = 50,
|
|
|
|
.scl = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_10,
|
|
|
|
.GPIO_Speed = GPIO_Speed_10MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_OD,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.sda = {
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_11,
|
|
|
|
.GPIO_Speed = GPIO_Speed_10MHz,
|
|
|
|
.GPIO_Mode = GPIO_Mode_AF_OD,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.event = {
|
|
|
|
.flags = 0, /* FIXME: check this */
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = I2C2_EV_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_HIGHEST,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
.error = {
|
|
|
|
.flags = 0, /* FIXME: check this */
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = I2C2_ER_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_HIGHEST,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
2011-02-12 23:19:54 +01:00
|
|
|
uint32_t pios_i2c_main_adapter_id;
|
2010-08-08 06:15:08 +02:00
|
|
|
void PIOS_I2C_main_adapter_ev_irq_handler(void)
|
|
|
|
{
|
2011-03-05 10:21:32 +01:00
|
|
|
#ifdef I2C_DEBUG_PIN
|
|
|
|
PIOS_DEBUG_PinHigh(I2C_DEBUG_PIN);
|
|
|
|
#endif
|
|
|
|
/* Call into the generic code to handle the IRQ for this specific device */
|
|
|
|
PIOS_I2C_EV_IRQ_Handler(pios_i2c_main_adapter_id);
|
|
|
|
#ifdef I2C_DEBUG_PIN
|
|
|
|
PIOS_DEBUG_PinLow(I2C_DEBUG_PIN);
|
|
|
|
#endif
|
2010-08-08 06:15:08 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
void PIOS_I2C_main_adapter_er_irq_handler(void)
|
|
|
|
{
|
|
|
|
/* Call into the generic code to handle the IRQ for this specific device */
|
2011-02-12 23:19:54 +01:00
|
|
|
PIOS_I2C_ER_IRQ_Handler(pios_i2c_main_adapter_id);
|
2010-08-08 06:15:08 +02:00
|
|
|
}
|
|
|
|
|
2011-02-12 23:19:54 +01:00
|
|
|
#endif /* PIOS_INCLUDE_I2C */
|
|
|
|
|
2011-02-06 02:03:06 +01:00
|
|
|
#if defined(PIOS_ENABLE_DEBUG_PINS)
|
|
|
|
|
|
|
|
static const struct stm32_gpio pios_debug_pins[] = {
|
|
|
|
#define PIOS_DEBUG_PIN_SERVO_1 0
|
|
|
|
{
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_6,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
2011-02-19 10:11:00 +01:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
2011-02-06 02:03:06 +01:00
|
|
|
},
|
|
|
|
},
|
|
|
|
#define PIOS_DEBUG_PIN_SERVO_2 1
|
|
|
|
{
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_7,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
2011-02-19 10:11:00 +01:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
2011-02-06 02:03:06 +01:00
|
|
|
},
|
|
|
|
},
|
|
|
|
#define PIOS_DEBUG_PIN_SERVO_3 2
|
|
|
|
{
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_8,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
2011-02-19 10:11:00 +01:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
2011-02-06 02:03:06 +01:00
|
|
|
},
|
|
|
|
},
|
|
|
|
#define PIOS_DEBUG_PIN_SERVO_4 3
|
|
|
|
{
|
|
|
|
.gpio = GPIOB,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_9,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
2011-02-19 10:11:00 +01:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
2011-02-06 02:03:06 +01:00
|
|
|
},
|
|
|
|
},
|
|
|
|
#define PIOS_DEBUG_PIN_SERVO_5 4
|
|
|
|
{
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_6,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
2011-02-19 10:11:00 +01:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
2011-02-06 02:03:06 +01:00
|
|
|
},
|
|
|
|
},
|
|
|
|
#define PIOS_DEBUG_PIN_SERVO_6 5
|
|
|
|
{
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_7,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
2011-02-19 10:11:00 +01:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
2011-02-06 02:03:06 +01:00
|
|
|
},
|
|
|
|
},
|
|
|
|
#define PIOS_DEBUG_PIN_SERVO_7 6
|
|
|
|
{
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_8,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
2011-02-19 10:11:00 +01:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
2011-02-06 02:03:06 +01:00
|
|
|
},
|
|
|
|
},
|
|
|
|
#define PIOS_DEBUG_PIN_SERVO_8 7
|
|
|
|
{
|
|
|
|
.gpio = GPIOC,
|
|
|
|
.init = {
|
|
|
|
.GPIO_Pin = GPIO_Pin_9,
|
|
|
|
.GPIO_Speed = GPIO_Speed_50MHz,
|
2011-02-19 10:11:00 +01:00
|
|
|
.GPIO_Mode = GPIO_Mode_Out_PP,
|
2011-02-06 02:03:06 +01:00
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
|
|
|
|
#endif /* PIOS_ENABLE_DEBUG_PINS */
|
|
|
|
|
2011-06-25 15:27:28 +02:00
|
|
|
#if defined(PIOS_INCLUDE_RCVR)
|
|
|
|
#include "pios_rcvr_priv.h"
|
|
|
|
|
2011-07-30 21:04:24 +02:00
|
|
|
/* One slot per selectable receiver group.
|
2011-11-04 19:43:49 +01:00
|
|
|
* eg. PWM, PPM, GCS, DSMMAINPORT, DSMFLEXIPORT, SBUS
|
2011-07-30 21:04:24 +02:00
|
|
|
* NOTE: No slot in this map for NONE.
|
|
|
|
*/
|
|
|
|
uint32_t pios_rcvr_group_map[MANUALCONTROLSETTINGS_CHANNELGROUPS_NONE];
|
|
|
|
|
2011-06-25 15:27:28 +02:00
|
|
|
#endif /* PIOS_INCLUDE_RCVR */
|
|
|
|
|
2011-07-26 06:27:03 +02:00
|
|
|
#if defined(PIOS_INCLUDE_USB_HID)
|
|
|
|
#include "pios_usb_hid_priv.h"
|
|
|
|
|
2011-09-08 03:39:56 +02:00
|
|
|
static const struct pios_usb_cfg pios_usb_main_cfg = {
|
2011-07-26 06:27:03 +02:00
|
|
|
.irq = {
|
|
|
|
.init = {
|
|
|
|
.NVIC_IRQChannel = USB_LP_CAN1_RX0_IRQn,
|
|
|
|
.NVIC_IRQChannelPreemptionPriority = PIOS_IRQ_PRIO_LOW,
|
|
|
|
.NVIC_IRQChannelSubPriority = 0,
|
|
|
|
.NVIC_IRQChannelCmd = ENABLE,
|
|
|
|
},
|
|
|
|
},
|
|
|
|
};
|
|
|
|
#endif /* PIOS_INCLUDE_USB_HID */
|
|
|
|
|
2011-09-08 03:39:56 +02:00
|
|
|
#if defined(PIOS_INCLUDE_USB_COM)
|
|
|
|
#include <pios_usb_com_priv.h>
|
|
|
|
|
|
|
|
const struct pios_usb_com_cfg pios_usb_com_hid_cfg = {
|
|
|
|
.type = PIOS_USB_COM_HID,
|
|
|
|
.data_if = 0,
|
|
|
|
.data_rx_ep = 1,
|
|
|
|
.data_tx_ep = 1,
|
|
|
|
};
|
|
|
|
|
|
|
|
#endif /* PIOS_INCLUDE_USB_COM */
|
2011-02-12 23:19:43 +01:00
|
|
|
|
|
|
|
uint32_t pios_com_telem_rf_id;
|
2011-09-08 03:39:56 +02:00
|
|
|
uint32_t pios_com_telem_usb_hid_id;
|
|
|
|
uint32_t pios_com_telem_usb_cdc_id;
|
2011-02-12 23:19:43 +01:00
|
|
|
uint32_t pios_com_gps_id;
|
|
|
|
uint32_t pios_com_aux_id;
|
2011-11-04 20:40:34 +01:00
|
|
|
uint32_t pios_com_dsm_id;
|
2011-02-12 23:19:43 +01:00
|
|
|
|
2011-02-12 23:19:50 +01:00
|
|
|
#include "ahrs_spi_comm.h"
|
|
|
|
|
2011-02-12 23:19:43 +01:00
|
|
|
/**
|
|
|
|
* PIOS_Board_Init()
|
|
|
|
* initializes all the core subsystems on this specific hardware
|
|
|
|
* called from System/openpilot.c
|
|
|
|
*/
|
|
|
|
void PIOS_Board_Init(void) {
|
|
|
|
|
|
|
|
/* Remap AFIO pin */
|
|
|
|
//GPIO_PinRemapConfig( GPIO_Remap_SWJ_NoJTRST, ENABLE);
|
|
|
|
|
2011-08-13 05:23:16 +02:00
|
|
|
#ifdef PIOS_DEBUG_ENABLE_DEBUG_PINS
|
|
|
|
PIOS_DEBUG_Init(&pios_tim_servo_all_channels, NELEMENTS(pios_tim_servo_all_channels));
|
|
|
|
#endif /* PIOS_DEBUG_ENABLE_DEBUG_PINS */
|
2011-03-05 10:21:32 +01:00
|
|
|
|
2011-02-12 23:19:43 +01:00
|
|
|
/* Delay system */
|
|
|
|
PIOS_DELAY_Init();
|
|
|
|
|
2011-02-12 23:19:50 +01:00
|
|
|
#if defined(PIOS_INCLUDE_SPI)
|
|
|
|
/* Set up the SPI interface to the SD card */
|
|
|
|
if (PIOS_SPI_Init(&pios_spi_sdcard_id, &pios_spi_sdcard_cfg)) {
|
2011-07-07 04:34:59 +02:00
|
|
|
PIOS_Assert(0);
|
2011-02-12 23:19:50 +01:00
|
|
|
}
|
2011-02-12 23:19:43 +01:00
|
|
|
|
|
|
|
/* Enable and mount the SDCard */
|
2011-02-12 23:19:50 +01:00
|
|
|
PIOS_SDCARD_Init(pios_spi_sdcard_id);
|
2011-02-12 23:19:43 +01:00
|
|
|
PIOS_SDCARD_MountFS(0);
|
2011-02-12 23:19:50 +01:00
|
|
|
#endif /* PIOS_INCLUDE_SPI */
|
|
|
|
|
2011-02-12 23:19:43 +01:00
|
|
|
/* Initialize UAVObject libraries */
|
|
|
|
EventDispatcherInitialize();
|
|
|
|
UAVObjInitialize();
|
|
|
|
|
2011-08-20 01:25:49 +02:00
|
|
|
HwSettingsInitialize();
|
|
|
|
|
2011-07-03 01:25:35 +02:00
|
|
|
#if defined(PIOS_INCLUDE_RTC)
|
|
|
|
/* Initialize the real-time clock and its associated tick */
|
|
|
|
PIOS_RTC_Init(&pios_rtc_main_cfg);
|
|
|
|
#endif
|
|
|
|
|
2011-02-12 23:19:43 +01:00
|
|
|
/* Initialize the alarms library */
|
|
|
|
AlarmsInitialize();
|
|
|
|
|
|
|
|
/* Initialize the task monitor library */
|
|
|
|
TaskMonitorInitialize();
|
|
|
|
|
2011-08-13 05:23:16 +02:00
|
|
|
/* Set up pulse timers */
|
|
|
|
PIOS_TIM_InitClock(&tim_1_cfg);
|
|
|
|
PIOS_TIM_InitClock(&tim_3_cfg);
|
|
|
|
PIOS_TIM_InitClock(&tim_5_cfg);
|
|
|
|
|
|
|
|
PIOS_TIM_InitClock(&tim_4_cfg);
|
|
|
|
PIOS_TIM_InitClock(&tim_8_cfg);
|
|
|
|
|
2011-02-12 23:19:50 +01:00
|
|
|
/* Prepare the AHRS Comms upper layer protocol */
|
|
|
|
AhrsInitComms();
|
|
|
|
|
|
|
|
/* Set up the SPI interface to the AHRS */
|
|
|
|
if (PIOS_SPI_Init(&pios_spi_ahrs_id, &pios_spi_ahrs_cfg)) {
|
2011-07-07 04:34:59 +02:00
|
|
|
PIOS_Assert(0);
|
2011-02-12 23:19:50 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
/* Bind the AHRS comms layer to the AHRS SPI link */
|
|
|
|
AhrsConnect(pios_spi_ahrs_id);
|
|
|
|
|
2011-07-30 21:04:24 +02:00
|
|
|
/* Configure the main IO port */
|
|
|
|
uint8_t hwsettings_op_mainport;
|
|
|
|
HwSettingsOP_MainPortGet(&hwsettings_op_mainport);
|
|
|
|
|
|
|
|
switch (hwsettings_op_mainport) {
|
|
|
|
case HWSETTINGS_OP_MAINPORT_DISABLED:
|
|
|
|
break;
|
|
|
|
case HWSETTINGS_OP_MAINPORT_TELEMETRY:
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
#if defined(PIOS_INCLUDE_TELEMETRY_RF)
|
2011-07-30 21:04:24 +02:00
|
|
|
{
|
|
|
|
uint32_t pios_usart_telem_rf_id;
|
|
|
|
if (PIOS_USART_Init(&pios_usart_telem_rf_id, &pios_usart_telem_cfg)) {
|
|
|
|
PIOS_Assert(0);
|
|
|
|
}
|
2011-07-29 16:04:55 +02:00
|
|
|
|
2011-07-30 21:04:24 +02:00
|
|
|
uint8_t * rx_buffer = (uint8_t *) pvPortMalloc(PIOS_COM_TELEM_RF_RX_BUF_LEN);
|
|
|
|
uint8_t * tx_buffer = (uint8_t *) pvPortMalloc(PIOS_COM_TELEM_RF_TX_BUF_LEN);
|
|
|
|
PIOS_Assert(rx_buffer);
|
|
|
|
PIOS_Assert(tx_buffer);
|
|
|
|
if (PIOS_COM_Init(&pios_com_telem_rf_id, &pios_usart_com_driver, pios_usart_telem_rf_id,
|
|
|
|
rx_buffer, PIOS_COM_TELEM_RF_RX_BUF_LEN,
|
|
|
|
tx_buffer, PIOS_COM_TELEM_RF_TX_BUF_LEN)) {
|
|
|
|
PIOS_Assert(0);
|
|
|
|
}
|
2011-07-29 16:04:55 +02:00
|
|
|
}
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
#endif /* PIOS_INCLUDE_TELEMETRY_RF */
|
2011-07-30 21:04:24 +02:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Configure the flexi port */
|
|
|
|
uint8_t hwsettings_op_flexiport;
|
|
|
|
HwSettingsOP_FlexiPortGet(&hwsettings_op_flexiport);
|
2011-02-12 23:19:43 +01:00
|
|
|
|
2011-07-30 21:04:24 +02:00
|
|
|
switch (hwsettings_op_flexiport) {
|
|
|
|
case HWSETTINGS_OP_FLEXIPORT_DISABLED:
|
|
|
|
break;
|
|
|
|
case HWSETTINGS_OP_FLEXIPORT_GPS:
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
#if defined(PIOS_INCLUDE_GPS)
|
2011-09-01 03:43:57 +02:00
|
|
|
{
|
|
|
|
uint32_t pios_usart_gps_id;
|
|
|
|
if (PIOS_USART_Init(&pios_usart_gps_id, &pios_usart_gps_cfg)) {
|
|
|
|
PIOS_Assert(0);
|
|
|
|
}
|
|
|
|
uint8_t * rx_buffer = (uint8_t *) pvPortMalloc(PIOS_COM_GPS_RX_BUF_LEN);
|
|
|
|
PIOS_Assert(rx_buffer);
|
|
|
|
if (PIOS_COM_Init(&pios_com_gps_id, &pios_usart_com_driver, pios_usart_gps_id,
|
|
|
|
rx_buffer, PIOS_COM_GPS_RX_BUF_LEN,
|
2011-09-05 05:22:29 +02:00
|
|
|
NULL, 0)) {
|
2011-09-01 03:43:57 +02:00
|
|
|
PIOS_Assert(0);
|
|
|
|
}
|
2011-07-29 16:04:55 +02:00
|
|
|
}
|
bootcfg: use UAVobj to control boot-time HW config
This should mark an end to the compile-time selection of HW
configurations.
Minor changes in board initialization for all platforms:
- Most config structs are marked static to prevent badly written
drivers from directly referring to config data.
- Adapt to changes in .irq fields in config data.
- Adapt to changes in USART IRQ handling.
Major changes in board initialization for CC:
- Use HwSettings UAVObj to decide which drivers to attach to
the "main" port and the flexi port, and select the appropriate
device configuration data.
- HwSettings allows choosing between Disabled, Telemetry, SBUS,
Spektrum,GPS, and I2C for each of the two ports.
- Use ManualControlSettings.InputMode to init/configure the
appropriate receiver module, and register its available rx channels
with the PIOS_RCVR layer. Can choose between PWM, Spektrum and PPM
at board init time. PPM driver is broken, and SBUS will work once
it is added to this UAVObj as an option.
- CC build now includes code for SBUS, Spektrum and PWM receivers in
every firmware image.
PIOS_USART driver:
- Now handles its own low-level IRQs internally
- If NULL upper-level IRQ handler is bound in at board init time
then rx/tx is satisfied by internal PIOS_USART buffered IO routines
which are (typically) attached to the COM layer.
- If an alternate upper-level IRQ handler is bound in at board init
then that handler is called and expected to clear down the USART
IRQ sources. This is used by Spektrum and SBUS drivers.
PIOS_SBUS and PIOS_SPEKTRUM drivers:
- Improved data/API hiding
- No longer assume they know where their config data is stored which
allows for boot-time alternate configurations for the driver.
- Now registers an upper-level IRQ handlerwith the USART layer to
decouple the driver from which USART it is actually attached to.
2011-07-06 02:21:00 +02:00
|
|
|
#endif /* PIOS_INCLUDE_GPS */
|
2011-07-30 21:04:24 +02:00
|
|
|
break;
|
|
|
|
}
|
2011-02-12 23:19:43 +01:00
|
|
|
|
2011-08-13 05:23:16 +02:00
|
|
|
#ifndef PIOS_DEBUG_ENABLE_DEBUG_PINS
|
|
|
|
PIOS_Servo_Init(&pios_servo_cfg);
|
|
|
|
#endif /* PIOS_DEBUG_ENABLE_DEBUG_PINS */
|
2011-02-12 23:19:43 +01:00
|
|
|
|
|
|
|
PIOS_ADC_Init();
|
|
|
|
PIOS_GPIO_Init();
|
|
|
|
|
2011-09-10 21:19:12 +02:00
|
|
|
/* Configure the rcvr port */
|
|
|
|
uint8_t hwsettings_rcvrport;
|
|
|
|
HwSettingsOP_RcvrPortGet(&hwsettings_rcvrport);
|
2011-06-25 15:27:28 +02:00
|
|
|
|
2011-07-30 21:04:24 +02:00
|
|
|
|
2011-09-10 21:19:12 +02:00
|
|
|
switch (hwsettings_rcvrport) {
|
|
|
|
case HWSETTINGS_OP_RCVRPORT_DISABLED:
|
2011-07-30 21:04:24 +02:00
|
|
|
break;
|
2011-09-10 21:19:12 +02:00
|
|
|
case HWSETTINGS_OP_RCVRPORT_DEBUG:
|
2011-07-30 21:04:24 +02:00
|
|
|
/* Not supported yet */
|
|
|
|
break;
|
2011-11-04 19:43:49 +01:00
|
|
|
case HWSETTINGS_OP_RCVRPORT_DSM2:
|
|
|
|
case HWSETTINGS_OP_RCVRPORT_DSMX10BIT:
|
|
|
|
case HWSETTINGS_OP_RCVRPORT_DSMX11BIT:
|
2011-11-04 20:40:34 +01:00
|
|
|
#if defined(PIOS_INCLUDE_DSM)
|
2011-07-30 21:04:24 +02:00
|
|
|
{
|
2011-11-04 19:43:49 +01:00
|
|
|
enum pios_dsm_proto proto;
|
|
|
|
switch (hwsettings_rcvrport) {
|
|
|
|
case HWSETTINGS_OP_RCVRPORT_DSM2:
|
|
|
|
proto = PIOS_DSM_PROTO_DSM2;
|
|
|
|
break;
|
|
|
|
case HWSETTINGS_OP_RCVRPORT_DSMX10BIT:
|
|
|
|
proto = PIOS_DSM_PROTO_DSMX10BIT;
|
|
|
|
break;
|
|
|
|
case HWSETTINGS_OP_RCVRPORT_DSMX11BIT:
|
|
|
|
proto = PIOS_DSM_PROTO_DSMX11BIT;
|
|
|
|
break;
|
|
|
|
default:
|
2011-07-30 21:04:24 +02:00
|
|
|
PIOS_Assert(0);
|
2011-11-04 19:43:49 +01:00
|
|
|
break;
|
2011-07-30 21:04:24 +02:00
|
|
|
}
|
2011-06-25 15:27:28 +02:00
|
|
|
|
2011-11-04 20:40:34 +01:00
|
|
|
uint32_t pios_usart_dsm_id;
|
|
|
|
if (PIOS_USART_Init(&pios_usart_dsm_id, &pios_usart_dsm_cfg)) {
|
2011-07-30 21:04:24 +02:00
|
|
|
PIOS_Assert(0);
|
2011-07-15 03:52:07 +02:00
|
|
|
}
|
2011-07-30 21:04:24 +02:00
|
|
|
|
2011-11-04 20:40:34 +01:00
|
|
|
uint32_t pios_dsm_id;
|
|
|
|
if (PIOS_DSM_Init(&pios_dsm_id,
|
|
|
|
&pios_dsm_cfg,
|
|
|
|
&pios_usart_com_driver,
|
|
|
|
pios_usart_dsm_id,
|
|
|
|
proto, 0)) {
|
2011-07-30 21:04:24 +02:00
|
|
|
PIOS_Assert(0);
|
2011-07-15 03:52:07 +02:00
|
|
|
}
|
2011-07-30 21:04:24 +02:00
|
|
|
|
2011-11-04 20:40:34 +01:00
|
|
|
uint32_t pios_dsm_rcvr_id;
|
|
|
|
if (PIOS_RCVR_Init(&pios_dsm_rcvr_id, &pios_dsm_rcvr_driver, pios_dsm_id)) {
|
2011-07-30 21:04:24 +02:00
|
|
|
PIOS_Assert(0);
|
2011-07-15 03:52:07 +02:00
|
|
|
}
|
2011-11-04 20:40:34 +01:00
|
|
|
pios_rcvr_group_map[MANUALCONTROLSETTINGS_CHANNELGROUPS_DSMMAINPORT] = pios_dsm_rcvr_id;
|
2011-07-30 21:04:24 +02:00
|
|
|
}
|
2011-06-25 15:27:28 +02:00
|
|
|
#endif
|
2011-07-30 21:04:24 +02:00
|
|
|
break;
|
2011-09-10 21:19:12 +02:00
|
|
|
case HWSETTINGS_OP_RCVRPORT_PWM:
|
2011-07-30 21:04:24 +02:00
|
|
|
#if defined(PIOS_INCLUDE_PWM)
|
2011-08-13 05:23:16 +02:00
|
|
|
{
|
|
|
|
uint32_t pios_pwm_id;
|
|
|
|
PIOS_PWM_Init(&pios_pwm_id, &pios_pwm_cfg);
|
|
|
|
|
2011-07-15 03:52:07 +02:00
|
|
|
uint32_t pios_pwm_rcvr_id;
|
2011-08-13 05:23:16 +02:00
|
|
|
if (PIOS_RCVR_Init(&pios_pwm_rcvr_id, &pios_pwm_rcvr_driver, pios_pwm_id)) {
|
|
|
|
PIOS_Assert(0);
|
2011-07-15 03:52:07 +02:00
|
|
|
}
|
2011-08-13 05:23:16 +02:00
|
|
|
pios_rcvr_group_map[MANUALCONTROLSETTINGS_CHANNELGROUPS_PWM] = pios_pwm_rcvr_id;
|
2011-07-30 21:04:24 +02:00
|
|
|
}
|
|
|
|
#endif /* PIOS_INCLUDE_PWM */
|
|
|
|
break;
|
2011-09-10 21:19:12 +02:00
|
|
|
case HWSETTINGS_OP_RCVRPORT_PPM:
|
2011-02-12 23:19:43 +01:00
|
|
|
#if defined(PIOS_INCLUDE_PPM)
|
2011-08-13 05:23:16 +02:00
|
|
|
{
|
|
|
|
uint32_t pios_ppm_id;
|
|
|
|
PIOS_PPM_Init(&pios_ppm_id, &pios_ppm_cfg);
|
|
|
|
|
2011-07-15 03:52:07 +02:00
|
|
|
uint32_t pios_ppm_rcvr_id;
|
2011-08-13 05:23:16 +02:00
|
|
|
if (PIOS_RCVR_Init(&pios_ppm_rcvr_id, &pios_ppm_rcvr_driver, pios_ppm_id)) {
|
|
|
|
PIOS_Assert(0);
|
2011-07-15 03:52:07 +02:00
|
|
|
}
|
2011-08-13 05:23:16 +02:00
|
|
|
pios_rcvr_group_map[MANUALCONTROLSETTINGS_CHANNELGROUPS_PPM] = pios_ppm_rcvr_id;
|
2011-07-30 21:04:24 +02:00
|
|
|
}
|
2011-07-12 18:41:21 +02:00
|
|
|
#endif /* PIOS_INCLUDE_PPM */
|
2011-07-30 21:04:24 +02:00
|
|
|
break;
|
2011-07-12 18:41:21 +02:00
|
|
|
}
|
|
|
|
|
2011-02-12 23:19:43 +01:00
|
|
|
#if defined(PIOS_INCLUDE_USB_HID)
|
2011-09-08 03:39:56 +02:00
|
|
|
uint32_t pios_usb_id;
|
|
|
|
PIOS_USB_Init(&pios_usb_id, &pios_usb_main_cfg);
|
2011-02-12 23:19:43 +01:00
|
|
|
#if defined(PIOS_INCLUDE_COM)
|
2011-09-08 03:39:56 +02:00
|
|
|
uint32_t pios_usb_com_id;
|
|
|
|
if (PIOS_USB_COM_Init(&pios_usb_com_id, &pios_usb_com_hid_cfg, pios_usb_id)) {
|
|
|
|
PIOS_Assert(0);
|
|
|
|
}
|
2011-07-29 16:04:55 +02:00
|
|
|
uint8_t * rx_buffer = (uint8_t *) pvPortMalloc(PIOS_COM_TELEM_USB_RX_BUF_LEN);
|
|
|
|
uint8_t * tx_buffer = (uint8_t *) pvPortMalloc(PIOS_COM_TELEM_USB_TX_BUF_LEN);
|
|
|
|
PIOS_Assert(rx_buffer);
|
|
|
|
PIOS_Assert(tx_buffer);
|
2011-09-08 03:39:56 +02:00
|
|
|
if (PIOS_COM_Init(&pios_com_telem_usb_hid_id, &pios_usb_hid_com_driver, pios_usb_com_id,
|
2011-07-29 16:04:55 +02:00
|
|
|
rx_buffer, PIOS_COM_TELEM_USB_RX_BUF_LEN,
|
|
|
|
tx_buffer, PIOS_COM_TELEM_USB_TX_BUF_LEN)) {
|
2011-07-07 04:34:59 +02:00
|
|
|
PIOS_Assert(0);
|
2011-02-12 23:19:43 +01:00
|
|
|
}
|
|
|
|
#endif /* PIOS_INCLUDE_COM */
|
2011-07-26 06:27:03 +02:00
|
|
|
#endif /* PIOS_INCLUDE_USB_HID */
|
2011-02-12 23:19:54 +01:00
|
|
|
|
|
|
|
#if defined(PIOS_INCLUDE_I2C)
|
|
|
|
if (PIOS_I2C_Init(&pios_i2c_main_adapter_id, &pios_i2c_main_adapter_cfg)) {
|
2011-07-07 04:34:59 +02:00
|
|
|
PIOS_Assert(0);
|
2011-02-12 23:19:54 +01:00
|
|
|
}
|
|
|
|
#endif /* PIOS_INCLUDE_I2C */
|
2011-02-12 23:19:43 +01:00
|
|
|
PIOS_IAP_Init();
|
|
|
|
PIOS_WDG_Init();
|
|
|
|
}
|
|
|
|
|
2010-07-28 09:28:21 +02:00
|
|
|
/**
|
|
|
|
* @}
|
|
|
|
*/
|