Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-27 02:05:31 +03:00
Code Issues Wiki Activity

Move STM (and clone) specific IO initialisation to platform (#14123)

Browse source 
* Move stm (and clone) specific io initialisation to platform

* Removed unused includes and implemented get by tag for SITL

* Update sitl.c

Corrected return value

* Update io_impl.c

Corrected licence file
This commit is contained in:
Jay Blackman 2025-01-06 04:51:45 +11:00 • committed by GitHub
parent 926c21ce7d
commit d82cd5a28a
No known key found for this signature in database
GPG key ID: B5690EEEBB952194
6 changed files with 87 additions and 45 deletions
Download patch file Download diff file Expand all files Collapse all files

44
src/main/drivers/io.c
View file

@ -129,14 +129,6 @@ bool IOIsFreeOrPreinit(IO_t io)
return false;
}
#if DEFIO_PORT_USED_COUNT > 0
static const uint16_t ioDefUsedMask[DEFIO_PORT_USED_COUNT] = { DEFIO_PORT_USED_LIST };
static const uint8_t ioDefUsedOffset[DEFIO_PORT_USED_COUNT] = { DEFIO_PORT_OFFSET_LIST };
#else
// Avoid -Wpedantic warning
static const uint16_t ioDefUsedMask[1] = {0};
static const uint8_t ioDefUsedOffset[1] = {0};
#endif
#if DEFIO_IO_USED_COUNT
ioRec_t ioRecs[DEFIO_IO_USED_COUNT];
#else
@ -144,42 +136,6 @@ ioRec_t ioRecs[DEFIO_IO_USED_COUNT];
ioRec_t ioRecs[1];
#endif
// initialize all ioRec_t structures from ROM
// currently only bitmask is used, this may change in future
void IOInitGlobal(void)
{
ioRec_t *ioRec = ioRecs;
for (unsigned port = 0; port < ARRAYLEN(ioDefUsedMask); port++) {
for (unsigned pin = 0; pin < sizeof(ioDefUsedMask[0]) * 8; pin++) {
if (ioDefUsedMask[port] & (1 << pin)) {
ioRec->gpio = (GPIO_TypeDef *)(GPIOA_BASE + (port << 10)); // ports are 0x400 apart
ioRec->pin = 1 << pin;
ioRec++;
}
}
}
}
IO_t IOGetByTag(ioTag_t tag)
{
const int portIdx = DEFIO_TAG_GPIOID(tag);
const int pinIdx = DEFIO_TAG_PIN(tag);
if (portIdx < 0 || portIdx >= DEFIO_PORT_USED_COUNT) {
return NULL;
}
// check if pin exists
if (!(ioDefUsedMask[portIdx] & (1 << pinIdx))) {
return NULL;
}
// count bits before this pin on single port
int offset = popcount(((1 << pinIdx) - 1) & ioDefUsedMask[portIdx]);
// and add port offset
offset += ioDefUsedOffset[portIdx];
return ioRecs + offset;
}
void IOTraversePins(IOTraverseFuncPtr_t fnPtr)
{
for (int i = 0; i < DEFIO_IO_USED_COUNT; i++) {