Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

HAL_ChibiOS: added palReadLineMode() function 

used to change and restore line modes
This commit is contained in:
Andrew Tridgell 2018-11-15 21:15:57 +11:00
parent c8efff7ddc
commit a0ed658fcc
2 changed files with 32 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
libraries/AP_HAL_ChibiOS/hwdef/common/stm32_util.c
View File

@ -279,3 +279,26 @@ void peripheral_power_enable(void)
#endif
#endif
}
#if defined(STM32F7) || defined(STM32F4)
/*
read mode of a pin. This allows a pin config to be read, changed and
then written back
*/
iomode_t palReadLineMode(ioline_t line)
{
ioportid_t port = PAL_PORT(line);
uint8_t pad = PAL_PAD(line);
iomode_t ret = 0;
ret |= (port->MODER >> (pad*2)) & 0x3;
ret |= ((port->OTYPER >> pad)&1) << 2;
ret |= ((port->OSPEEDR >> (pad*2))&3) << 3;
ret |= ((port->PUPDR >> (pad*2))&3) << 5;
if (pad < 8) {
ret |= ((port->AFRL >> (pad*4))&0xF) << 7;
} else {
ret |= ((port->AFRH >> ((pad-8)*4))&0xF) << 7;
}
return ret;
}
#endif

10
libraries/AP_HAL_ChibiOS/hwdef/common/stm32_util.h
View File

@ -69,7 +69,15 @@ void peripheral_power_enable(void);
// initialise allocation subsystem
void malloc_init(void);
/*
read mode of a pin. This allows a pin config to be read, changed and
then written back
*/
#if defined(STM32F7) || defined(STM32F4)
iomode_t palReadLineMode(ioline_t line);
#endif
#ifdef __cplusplus
}
#endif