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.
87 lines
2.0 KiB
87 lines
2.0 KiB
7 years ago
|
//
|
||
|
|
// Created by MightyPork on 2017/12/15.
|
||
|
|
//
|
||
|
|
|
||
|
|
#include <sched_queue.h>
|
||
|
|
#include <task_sched.h>
|
||
|
|
#include "usbd_core.h"
|
||
|
|
#include "USB/usb_device.h"
|
||
|
|
|
||
|
|
#include "framework/settings.h"
|
||
|
|
#include "framework/resources.h"
|
||
|
|
#include "framework/system_settings.h"
|
||
|
|
#include "pin_utils.h"
|
||
|
|
#include "lock_jumper.h"
|
||
|
|
|
||
|
|
static GPIO_TypeDef *lock_periph;
|
||
|
|
static uint32_t lock_llpin;
|
||
|
|
|
||
|
|
// We use macros LOCK_JUMPER_PORT, LOCK_JUMPER_PIN from plat_compat.h
|
||
|
|
|
||
|
|
/** Init the jumper subsystem */
|
||
|
|
void LockJumper_Init(void)
|
||
|
|
{
|
||
|
|
bool suc = true;
|
||
|
|
|
||
|
|
// Resolve and claim resource
|
||
|
|
Resource rsc = plat_pin2resource(LOCK_JUMPER_PORT, LOCK_JUMPER_PIN, &suc);
|
||
|
|
assert_param(suc);
|
||
|
|
|
||
|
|
suc &= rsc_claim(&UNIT_SYSTEM, rsc);
|
||
|
|
assert_param(suc);
|
||
|
|
|
||
|
|
// Resolve pin
|
||
|
|
lock_periph = plat_port2periph(LOCK_JUMPER_PORT, &suc);
|
||
|
|
lock_llpin = plat_pin2ll(LOCK_JUMPER_PIN, &suc);
|
||
|
|
assert_param(suc);
|
||
|
|
|
||
|
|
// Configure for input
|
||
|
|
LL_GPIO_SetPinMode(lock_periph, lock_llpin, LL_GPIO_MODE_INPUT);
|
||
|
|
LL_GPIO_SetPinPull(lock_periph, lock_llpin, LL_GPIO_PULL_UP);
|
||
|
|
|
||
|
|
SystemSettings.editable = (bool) LL_GPIO_IsInputPinSet(lock_periph, lock_llpin);
|
||
|
|
dbg("Settings editable? %d", SystemSettings.editable);
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/** Handle jumper state change */
|
||
|
|
static void jumper_changed(void)
|
||
|
|
{
|
||
|
|
if (SystemSettings.editable) {
|
||
|
|
// Unlock
|
||
|
|
dbg("LOCK jumper removed, enabling MSC!");
|
||
|
|
} else {
|
||
|
|
// Lock
|
||
|
|
dbg("LOCK jumper replaced, saving to Flash & disabling MSC!");
|
||
|
|
|
||
|
|
if (SystemSettings.modified) {
|
||
|
|
settings_save();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
plat_usb_reconnect();
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/** Periodic jumper check */
|
||
|
|
void LockJumper_Check(void)
|
||
|
|
{
|
||
|
|
// Debounce cooldown
|
||
|
|
static uint32_t cooldown = 0;
|
||
|
|
if (cooldown > 0) {
|
||
|
|
cooldown--;
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
// Read the pin state
|
||
|
|
bool old = SystemSettings.editable;
|
||
|
|
SystemSettings.editable = (bool) LL_GPIO_IsInputPinSet(lock_periph, lock_llpin);
|
||
|
|
|
||
|
|
if (old != SystemSettings.editable) {
|
||
|
|
// --- State changed ---
|
||
|
|
cooldown = 5; // 0.5s if called every 100 ms
|
||
|
|
|
||
|
|
jumper_changed();
|
||
|
|
}
|
||
|
|
}
|