You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
129 lines
3.4 KiB
129 lines
3.4 KiB
//
|
|
// Created by MightyPork on 2018/02/03.
|
|
//
|
|
|
|
#include "platform.h"
|
|
#include "unit_base.h"
|
|
|
|
#define DIN_INTERNAL
|
|
#include "_din_internal.h"
|
|
#include "_din_init.h"
|
|
#include "_din_exti.h"
|
|
|
|
/** Allocate data structure and set defaults */
|
|
error_t DI_preInit(Unit *unit)
|
|
{
|
|
struct priv *priv = unit->data = calloc_ck(1, sizeof(struct priv));
|
|
if (priv == NULL) return E_OUT_OF_MEM;
|
|
|
|
// some defaults
|
|
priv->port_name = 'A';
|
|
priv->pins = 0x0001;
|
|
priv->pulldown = 0x0000;
|
|
priv->pullup = 0x0000;
|
|
|
|
priv->trig_rise = 0x0000;
|
|
priv->trig_fall = 0x0000;
|
|
priv->trig_holdoff = 100;
|
|
priv->def_auto = 0x0000;
|
|
|
|
return E_SUCCESS;
|
|
}
|
|
|
|
/** Finalize unit set-up */
|
|
error_t DI_init(Unit *unit)
|
|
{
|
|
bool suc = true;
|
|
struct priv *priv = unit->data;
|
|
|
|
priv->pulldown &= priv->pins;
|
|
priv->pullup &= priv->pins;
|
|
priv->trig_rise &= priv->pins;
|
|
priv->trig_fall &= priv->pins;
|
|
priv->def_auto &= (priv->trig_rise|priv->trig_fall);
|
|
|
|
// copy auto-arm defaults to the auto-arm register (the register may be manipulated by commands)
|
|
priv->arm_auto = priv->def_auto;
|
|
priv->arm_single = 0;
|
|
|
|
// clear countdowns
|
|
memset(priv->holdoff_countdowns, 0, sizeof(priv->holdoff_countdowns));
|
|
|
|
// --- Parse config ---
|
|
priv->port = hw_port2periph(priv->port_name, &suc);
|
|
if (!suc) return E_BAD_CONFIG;
|
|
|
|
// Claim all needed pins
|
|
TRY(rsc_claim_gpios(unit, priv->port_name, priv->pins));
|
|
|
|
uint16_t mask = 1;
|
|
for (int i = 0; i < 16; i++, mask <<= 1) {
|
|
if (priv->pins & mask) {
|
|
uint32_t ll_pin = hw_pin2ll((uint8_t) i, &suc);
|
|
|
|
// --- Init hardware ---
|
|
LL_GPIO_SetPinMode(priv->port, ll_pin, LL_GPIO_MODE_INPUT);
|
|
|
|
uint32_t pull = 0;
|
|
|
|
#if PLAT_NO_FLOATING_INPUTS
|
|
pull = LL_GPIO_PULL_UP;
|
|
#else
|
|
pull = LL_GPIO_PULL_NO;
|
|
#endif
|
|
|
|
if (priv->pulldown & mask) pull = LL_GPIO_PULL_DOWN;
|
|
if (priv->pullup & mask) pull = LL_GPIO_PULL_UP;
|
|
LL_GPIO_SetPinPull(priv->port, ll_pin, pull);
|
|
|
|
if ((priv->trig_rise|priv->trig_fall) & mask) {
|
|
LL_EXTI_EnableIT_0_31(LL_EXTI_LINES[i]);
|
|
|
|
if (priv->trig_rise & mask) {
|
|
LL_EXTI_EnableRisingTrig_0_31(LL_EXTI_LINES[i]);
|
|
}
|
|
if (priv->trig_fall & mask) {
|
|
LL_EXTI_EnableFallingTrig_0_31(LL_EXTI_LINES[i]);
|
|
}
|
|
|
|
LL_SYSCFG_SetEXTISource(LL_SYSCFG_EXTI_PORTS[priv->port_name-'A'], LL_SYSCFG_EXTI_LINES[i]);
|
|
|
|
irqd_attach(EXTIS[i], DI_handleExti, unit);
|
|
}
|
|
}
|
|
}
|
|
|
|
// request ticks if we have triggers and any hold-offs configured
|
|
if ((priv->trig_rise|priv->trig_fall) && priv->trig_holdoff > 0) {
|
|
unit->tick_interval = 1;
|
|
}
|
|
|
|
return E_SUCCESS;
|
|
}
|
|
|
|
|
|
/** Tear down the unit */
|
|
void DI_deInit(Unit *unit)
|
|
{
|
|
struct priv *priv = unit->data;
|
|
|
|
// pins are de-inited during teardown
|
|
|
|
// Detach EXTI handlers and disable interrupts
|
|
const uint16_t triggs = priv->trig_rise | priv->trig_fall;
|
|
if (unit->status == E_SUCCESS && triggs) {
|
|
uint16_t mask = 1;
|
|
for (int i = 0; i < 16; i++, mask <<= 1) {
|
|
if (triggs & mask) {
|
|
LL_EXTI_DisableIT_0_31(LL_EXTI_LINES[i]);
|
|
irqd_detach(EXTIS[i], DI_handleExti);
|
|
}
|
|
}
|
|
}
|
|
|
|
// Release all resources
|
|
rsc_teardown(unit);
|
|
|
|
// Free memory
|
|
free_ck(unit->data);
|
|
}
|
|
|