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.
72 lines
1.8 KiB
72 lines
1.8 KiB
7 years ago
|
//
|
||
|
|
// Created by MightyPork on 2018/02/03.
|
||
|
|
//
|
||
|
|
|
||
|
|
#include "platform.h"
|
||
|
|
#include "unit_base.h"
|
||
|
|
#include "unit_din.h"
|
||
|
|
|
||
|
|
#define DIN_INTERNAL
|
||
|
|
|
||
|
|
#include "_din_internal.h"
|
||
|
|
|
||
|
|
/** Read request */
|
||
|
|
error_t UU_DI_Read(Unit *unit, uint16_t *packed)
|
||
|
|
{
|
||
|
|
CHECK_TYPE(unit, &UNIT_DIN);
|
||
|
|
struct priv *priv = unit->data;
|
||
|
|
*packed = pinmask_pack((uint16_t) priv->port->IDR, priv->pins);
|
||
|
|
return E_SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
/** Arm pins */
|
||
|
|
error_t UU_DI_Arm(Unit *unit, uint16_t arm_single_packed, uint16_t arm_auto_packed)
|
||
|
|
{
|
||
|
|
CHECK_TYPE(unit, &UNIT_DIN);
|
||
|
|
struct priv *priv = unit->data;
|
||
|
|
|
||
|
|
uint16_t arm_single = pinmask_spread(arm_single_packed, priv->pins);
|
||
|
|
uint16_t arm_auto = pinmask_spread(arm_auto_packed, priv->pins);
|
||
|
|
|
||
|
|
// abort if user tries to arm pin that doesn't have a trigger configured
|
||
|
|
if (0 != ((arm_single | arm_auto) & ~(priv->trig_fall | priv->trig_rise))) {
|
||
|
|
return E_BAD_VALUE;
|
||
|
|
}
|
||
|
|
|
||
|
|
// arm and reset hold-offs
|
||
|
|
// we use critical section to avoid irq between the two steps
|
||
|
|
vPortEnterCritical();
|
||
|
|
{
|
||
|
|
priv->arm_auto |= arm_single;
|
||
|
|
priv->arm_single |= arm_auto;
|
||
|
|
const uint16_t combined = arm_single | arm_auto;
|
||
|
|
for (int i = 0; i < 16; i++) {
|
||
|
|
if (combined & (1 << i)) {
|
||
|
|
priv->holdoff_countdowns[i] = 0;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
vPortExitCritical();
|
||
|
|
|
||
|
|
return E_SUCCESS;
|
||
|
|
}
|
||
|
|
|
||
|
|
/** DisArm pins */
|
||
|
|
error_t UU_DI_DisArm(Unit *unit, uint16_t disarm_packed)
|
||
|
|
{
|
||
|
|
CHECK_TYPE(unit, &UNIT_DIN);
|
||
|
|
struct priv *priv = unit->data;
|
||
|
|
|
||
|
|
uint16_t disarm = pinmask_spread(disarm_packed, priv->pins);
|
||
|
|
|
||
|
|
// abort if user tries to disarm pin that doesn't have a trigger configured
|
||
|
|
if (0 != ((disarm) & ~(priv->trig_fall | priv->trig_rise))) {
|
||
|
|
return E_BAD_VALUE;
|
||
|
|
}
|
||
|
|
|
||
|
|
priv->arm_auto &= ~disarm;
|
||
|
|
priv->arm_single &= ~disarm;
|
||
|
|
|
||
|
|
return E_SUCCESS;
|
||
|
|
}
|