mirror of
https://github.com/betaflight/betaflight.git
synced 2025-07-25 17:25:20 +03:00
d82cd5a28a
* 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
70 lines
2.2 KiB
C
70 lines
2.2 KiB
C
/*
|
|
* This file is part of Betaflight.
|
|
*
|
|
* Betaflight is free software. You can redistribute this software
|
|
* and/or modify this software 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.
|
|
*
|
|
* Betaflight 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 software.
|
|
*
|
|
* If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include "platform.h"
|
|
|
|
#include "drivers/io.h"
|
|
#include "drivers/io_impl.h"
|
|
|
|
#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
|
|
|
|
// 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;
|
|
}
|