From 518383ada84d89a99f6686b38dc151951c143466 Mon Sep 17 00:00:00 2001 From: Simone Guscetti Date: Mon, 15 May 2017 09:27:44 +0200 Subject: [PATCH] fmu-v5: update board config to the newest pin assigment --- src/drivers/boards/px4fmu-v5/board_config.h | 52 ++++++++++----------- src/drivers/boards/px4fmu-v5/px4fmu_init.c | 6 +-- 2 files changed, 29 insertions(+), 29 deletions(-) diff --git a/src/drivers/boards/px4fmu-v5/board_config.h b/src/drivers/boards/px4fmu-v5/board_config.h index eb41a682df..9441035f78 100644 --- a/src/drivers/boards/px4fmu-v5/board_config.h +++ b/src/drivers/boards/px4fmu-v5/board_config.h @@ -71,19 +71,19 @@ __BEGIN_DECLS /* Define the Chip Selects */ -#define GPIO_SPI_CS_ICM20689 /* PF2 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN2) -#define GPIO_SPI_CS_ICM20602 /* PF3 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN3) -#define GPIO_SPI_CS_BMI055_GYR /* PF4 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN4) -#define GPIO_SPI_CS_MEMORY /* PF5 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN5) -#define GPIO_SPI_CS_MS5611 /* PF10 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN10) -#define GPIO_SPI_CS_BMI055_ACC /* PG10 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTG|GPIO_PIN10) +#define GPIO_SPI1_CS1_ICM20689 /* PF2 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN2) +#define GPIO_SPI1_CS2_ICM20602 /* PF3 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN3) +#define GPIO_SPI1_CS3_BMI055_GYRO /* PF4 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN4) +#define GPIO_SPI1_CS4_BMI055_ACC /* PG10 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTG|GPIO_PIN10) +#define GPIO_SPI2_CS_FRAM /* PF5 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN5) +#define GPIO_SPI4_CS1_MS5611 /* PF10 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTF|GPIO_PIN10) -#define SPI6_EXTERNAL1_CS1 /* PI4 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN4) -#define SPI6_EXTERNAL1_CS2 /* PI10 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN10) -#define SPI6_EXTERNAL1_CS3 /* PI11 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN11) -#define SPI6_EXTERNAL2_CS1 /* PI6 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN6) -#define SPI6_EXTERNAL2_CS2 /* PI7 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN7) -#define SPI6_EXTERNAL2_CS3 /* PI8 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN8) +#define SPI5_CS1_EXTERNAL1 /* PI4 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN4) +#define SPI5_CS2_EXTERNAL1 /* PI10 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN10) +#define SPI5_CS3_EXTERNAL1 /* PI11 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN11) +#define SPI6_CS1_EXTERNAL2 /* PI6 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN6) +#define SPI6_CS2_EXTERNAL2 /* PI7 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN7) +#define SPI6_CS3_EXTERNAL2 /* PI8 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTI|GPIO_PIN8) /* Define the Ready interrupts */ /* NOT FMUv5 test HW ONLY*/ @@ -132,22 +132,22 @@ __BEGIN_DECLS /* ^ END Legacy SPI defines TODO: fix this with enumeration */ -#define PX4_SPIDEV_ICM_20689 PX4_MK_SPI_SEL(PX4_SPI_BUS_SENSORS,0) -#define PX4_SPIDEV_ICM_20602 PX4_MK_SPI_SEL(PX4_SPI_BUS_SENSORS,1) -#define PX4_SPIDEV_BMI055_GYR PX4_MK_SPI_SEL(PX4_SPI_BUS_SENSORS,2) +#define PX4_SPIDEV_ICM_20689 PX4_MK_SPI_SEL(PX4_SPI_BUS_SENSORS,0) +#define PX4_SPIDEV_ICM_20602 PX4_MK_SPI_SEL(PX4_SPI_BUS_SENSORS,1) +#define PX4_SPIDEV_BMI055_GYR PX4_MK_SPI_SEL(PX4_SPI_BUS_SENSORS,2) #define PX4_SPIDEV_BMI055_ACC PX4_MK_SPI_SEL(PX4_SPI_BUS_SENSORS,3) -#define PX4_SENSOR_BUS_CS_GPIO {GPIO_SPI_CS_ICM20689, GPIO_SPI_CS_ICM20602, GPIO_SPI_CS_BMI055_GYR, GPIO_SPI_CS_BMI055_ACC} +#define PX4_SENSOR_BUS_CS_GPIO {GPIO_SPI1_CS1_ICM20689, GPIO_SPI1_CS2_ICM20602, GPIO_SPI1_CS3_BMI055_GYRO, GPIO_SPI1_CS4_BMI055_ACC} #define PX4_SENSORS_BUS_FIRST_CS PX4_SPIDEV_ICM_20689 #define PX4_SENSORS_BUS_LAST_CS PX4_SPIDEV_BMI055_ACC #define PX4_SPIDEV_MEMORY PX4_MK_SPI_SEL(PX4_SPI_BUS_MEMORY,0) -#define PX4_MEMORY_BUS_CS_GPIO {GPIO_SPI_CS_MEMORY} +#define PX4_MEMORY_BUS_CS_GPIO {GPIO_SPI2_CS_FRAM} #define PX4_MEMORY_BUS_FIRST_CS PX4_SPIDEV_MEMORY #define PX4_MEMORY_BUS_LAST_CS PX4_SPIDEV_MEMORY #define PX4_SPIDEV_BARO PX4_MK_SPI_SEL(PX4_SPI_BUS_BARO,0) -#define PX4_BARO_BUS_CS_GPIO {GPIO_SPI_CS_MS5611} +#define PX4_BARO_BUS_CS_GPIO {GPIO_SPI4_CS1_MS5611} #define PX4_BARO_BUS_FIRST_CS PX4_SPIDEV_BARO #define PX4_BARO_BUS_LAST_CS PX4_SPIDEV_BARO @@ -157,10 +157,10 @@ __BEGIN_DECLS #define PX4_SPIDEV_EXTERNAL4 PX4_MK_SPI_SEL(PX4_SPI_BUS_EXTERNAL,3) #define PX4_SPIDEV_EXTERNAL5 PX4_MK_SPI_SEL(PX4_SPI_BUS_EXTERNAL,4) #define PX4_SPIDEV_EXTERNAL6 PX4_MK_SPI_SEL(PX4_SPI_BUS_EXTERNAL,5) -#define PX4_EXTERNAL_BUS_CS_GPIO {SPI6_EXTERNAL1_CS1, SPI6_EXTERNAL1_CS2, \ - SPI6_EXTERNAL1_CS3, \ - SPI6_EXTERNAL2_CS1, SPI6_EXTERNAL2_CS2, \ - SPI6_EXTERNAL2_CS3} +#define PX4_EXTERNAL_BUS_CS_GPIO {SPI5_CS1_EXTERNAL1, SPI5_CS2_EXTERNAL1, \ + SPI5_CS3_EXTERNAL1, \ + SPI6_CS1_EXTERNAL2, SPI6_CS2_EXTERNAL2, \ + SPI6_CS3_EXTERNAL2} #define PX4_EXTERNAL_BUS_FIRST_CS PX4_SPIDEV_EXTERNAL1 #define PX4_EXTERNAL_BUS_LAST_CS PX4_SPIDEV_EXTERNAL6 @@ -294,7 +294,7 @@ __BEGIN_DECLS #define GPIO_VDD_BRICK_VALID /* PB10 */ (GPIO_INPUT|GPIO_PULLUP|GPIO_PORTB|GPIO_PIN10) #define GPIO_VDD_3V3_SENSORS_EN /* PE3 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTE|GPIO_PIN3) #define GPIO_VDD_3V3_SPEKTRUM_POWER_EN /* PE4 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTE|GPIO_PIN4) -#define GPIO_PERIPH_5V_EN /* PG4 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTG|GPIO_PIN4) +#define GPIO_nVDD_5V_PERIPH_EN /* PG4 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTG|GPIO_PIN4) #define GPIO_VDD_5V_RC_EN /* PG5 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTG|GPIO_PIN5) #define GPIO_VDD_5V_WIFI_EN /* PG6 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_SET|GPIO_PORTG|GPIO_PIN5) #define GPIO_VDD_3V3V_SD_CARD_EN /* PG7 */ (GPIO_OUTPUT|GPIO_PUSHPULL|GPIO_SPEED_2MHz|GPIO_OUTPUT_CLEAR|GPIO_PORTG|GPIO_PIN7) @@ -303,7 +303,7 @@ __BEGIN_DECLS #define SD_CARD_POWER_CTRL(on_true) px4_arch_gpiowrite(GPIO_VDD_3V3V_SD_CARD_EN, !(on_true)) -#define GPIO_VDD_5V_PERIPH_OC /* PE15 */ (GPIO_INPUT|GPIO_PULLUP|GPIO_PORTE|GPIO_PIN15) +#define GPIO_nVDD_5V_PERIPH_OC /* PE15 */ (GPIO_INPUT|GPIO_PULLUP|GPIO_PORTE|GPIO_PIN15) /* Tone alarm output */ #define TONE_ALARM_TIMER 9 /* timer 9 */ @@ -384,7 +384,7 @@ __BEGIN_DECLS #define BOARD_ADC_USB_CONNECTED (px4_arch_gpioread(GPIO_OTGFS_VBUS)) #define BOARD_ADC_BRICK_VALID (px4_arch_gpioread(GPIO_VDD_BRICK_VALID)) #define BOARD_ADC_SERVO_VALID (1) -#define BOARD_ADC_PERIPH_5V_OC (px4_arch_gpioread(GPIO_VDD_5V_PERIPH_OC)) +#define BOARD_ADC_PERIPH_5V_OC (px4_arch_gpioread(GPIO_nVDD_5V_PERIPH_OC)) #define BOARD_ADC_HIPOWER_5V_OC (0) #define BOARD_HAS_PWM DIRECT_PWM_OUTPUT_CHANNELS @@ -402,7 +402,7 @@ __BEGIN_DECLS {0, GPIO_VDD_3V3_SENSORS_EN, 0}, \ {GPIO_VDD_BRICK_VALID, 0, 0}, \ {0, GPIO_VDD_3V3_SPEKTRUM_POWER_EN, 0}, \ - {0, GPIO_PERIPH_5V_EN, 0}, \ + {0, GPIO_nVDD_5V_PERIPH_EN, 0}, \ {0, GPIO_VDD_5V_RC_EN, 0}, \ {0, GPIO_VDD_5V_WIFI_EN, 0}, \ {0, GPIO_VDD_3V3V_SD_CARD_EN, 0}, } diff --git a/src/drivers/boards/px4fmu-v5/px4fmu_init.c b/src/drivers/boards/px4fmu-v5/px4fmu_init.c index 13b206e69d..a705ff3f45 100644 --- a/src/drivers/boards/px4fmu-v5/px4fmu_init.c +++ b/src/drivers/boards/px4fmu-v5/px4fmu_init.c @@ -172,7 +172,7 @@ __EXPORT void board_peripheral_reset(int ms) { /* set the peripheral rails off */ - stm32_gpiowrite(GPIO_PERIPH_5V_EN, 0); + stm32_gpiowrite(GPIO_nVDD_5V_PERIPH_EN, 0); stm32_gpiowrite(GPIO_VDD_3V3_SENSORS_EN, 0); bool last = stm32_gpioread(GPIO_VDD_3V3_SPEKTRUM_POWER_EN); @@ -188,7 +188,7 @@ __EXPORT void board_peripheral_reset(int ms) /* switch the peripheral rail back on */ stm32_gpiowrite(GPIO_VDD_3V3_SPEKTRUM_POWER_EN, last); stm32_gpiowrite(GPIO_VDD_3V3_SENSORS_EN, 1); - stm32_gpiowrite(GPIO_PERIPH_5V_EN, 1); + stm32_gpiowrite(GPIO_nVDD_5V_PERIPH_EN, 1); } @@ -247,7 +247,7 @@ stm32_boardinitialize(void) stm32_configgpio(GPIO_POWER_IN_C); stm32_configgpio(GPIO_VDD_BRICK_VALID); - stm32_configgpio(GPIO_PERIPH_5V_EN); + stm32_configgpio(GPIO_nVDD_5V_PERIPH_EN); stm32_configgpio(GPIO_VDD_3V3_SENSORS_EN); stm32_configgpio(GPIO_VDD_3V3V_SD_CARD_EN); stm32_configgpio(GPIO_VDD_5V_RC_EN);