Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-26 01:35:41 +03:00
Code Issues Wiki Activity

PICO: Implement debug pin

Browse source
This commit is contained in:
blckmn 2025-07-08 10:42:45 +10:00
parent 1743a43d19
commit 156020cf01
7 changed files with 97 additions and 6 deletions
Download patch file Download diff file Expand all files Collapse all files

108
src/platform/common/stm32/debug_pin.c Normal file
View file

@ -0,0 +1,108 @@
/*
* This file is part of Cleanflight and Betaflight.
*
* Cleanflight and Betaflight are 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.
*
* Cleanflight and Betaflight are distributed in the hope that they
* 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 "build/debug_pin.h"
#ifdef USE_DEBUG_PIN
#ifndef DEBUG_PIN_COUNT
#define DEBUG_PIN_COUNT 0
#endif
#include "drivers/io.h"
#include "drivers/io_impl.h"
typedef struct dbgPinState_s {
GPIO_TypeDef *gpio;
uint32_t setBSRR;
uint32_t resetBSRR;
} dbgPinState_t;
dbgPinState_t dbgPinStates[DEBUG_PIN_COUNT] = { 0 };
extern dbgPin_t dbgPins[DEBUG_PIN_COUNT];
// Define this in the target definition as (and set DEBUG_PIN_COUNT to the correct value):
// dbgPin_t dbgPins[DEBUG_PIN_COUNT] = {
// { .tag = IO_TAG(<pin>) },
// };
#endif
void dbgPinInit(void)
{
#ifdef USE_DEBUG_PIN
for (unsigned i = 0; i < ARRAYLEN(dbgPins); i++) {
dbgPin_t *dbgPin = &dbgPins[i];
dbgPinState_t *dbgPinState = &dbgPinStates[i];
IO_t io = IOGetByTag(dbgPin->tag);
if (!io) {
continue;
}
IOInit(io, OWNER_SYSTEM, 0);
IOConfigGPIO(io, IOCFG_OUT_PP);
dbgPinState->gpio = IO_GPIO(io);
int pinSrc = IO_GPIO_PinSource(io);
dbgPinState->setBSRR = (1 << pinSrc);
dbgPinState->resetBSRR = (1 << (pinSrc + 16));
}
#endif
}
void dbgPinHi(int index)
{
#ifdef USE_DEBUG_PIN
if ((unsigned)index >= ARRAYLEN(dbgPins)) {
return;
}
dbgPinState_t *dbgPinState = &dbgPinStates[index];
if (dbgPinState->gpio) {
#if defined(STM32F7) || defined(STM32H7)
dbgPinState->gpio->BSRR = dbgPinState->setBSRR;
#else
dbgPinState->gpio->BSRRL = dbgPinState->setBSRR;
#endif
}
#else
UNUSED(index);
#endif
}
void dbgPinLo(int index)
{
#ifdef USE_DEBUG_PIN
if ((unsigned)index >= ARRAYLEN(dbgPins)) {
return;
}
dbgPinState_t *dbgPinState = &dbgPinStates[index];
if (dbgPinState->gpio) {
#if defined(STM32F7) || defined(STM32H7)
dbgPinState->gpio->BSRR = dbgPinState->resetBSRR;
#else
dbgPinState->gpio->BSRRL = dbgPinState->resetBSRR;
#endif
}
#else
UNUSED(index);
#endif
}