parent
06c46b20a6
commit
003b2f6899
|
|
@ -2,6 +2,10 @@
|
||||||
#include <stdint.h>
|
#include <stdint.h>
|
||||||
#include "axis.h"
|
#include "axis.h"
|
||||||
|
|
||||||
|
/// Define Debug mode to add additional serial output
|
||||||
|
|
||||||
|
//#define DEBUG_FINDA
|
||||||
|
|
||||||
/// Wrangler for assorted compile-time configuration and constants.
|
/// Wrangler for assorted compile-time configuration and constants.
|
||||||
namespace config {
|
namespace config {
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -171,6 +171,15 @@ void ReportCommandAccepted(const mp::RequestMsg &rq, mp::ResponseMsgParamCodes s
|
||||||
}
|
}
|
||||||
|
|
||||||
void ReportFINDA(const mp::RequestMsg &rq) {
|
void ReportFINDA(const mp::RequestMsg &rq) {
|
||||||
|
#ifdef DEBUG_FINDA
|
||||||
|
using namespace hal;
|
||||||
|
hu::usart1.puts("FINDA:");
|
||||||
|
if (hal::gpio::ReadPin(FINDA_PIN) == hal::gpio::Level::high) {
|
||||||
|
hu::usart1.puts(" TIRGGERED\n");
|
||||||
|
} else {
|
||||||
|
hu::usart1.puts(" NOT TRIGGERED\n");
|
||||||
|
}
|
||||||
|
#endif //DEBUG_FINDA
|
||||||
uint8_t rsp[maxMsgLen];
|
uint8_t rsp[maxMsgLen];
|
||||||
uint8_t len = protocol.EncodeResponseReadFINDA(rq, mf::finda.Pressed(), rsp);
|
uint8_t len = protocol.EncodeResponseReadFINDA(rq, mf::finda.Pressed(), rsp);
|
||||||
WriteToUSART(rsp, len);
|
WriteToUSART(rsp, len);
|
||||||
|
|
|
||||||
|
|
@ -1,6 +1,7 @@
|
||||||
#include "finda.h"
|
#include "finda.h"
|
||||||
#include "../hal/adc.h"
|
|
||||||
#include "timebase.h"
|
#include "timebase.h"
|
||||||
|
#include "../hal/gpio.h"
|
||||||
|
#include "../pins.h"
|
||||||
|
|
||||||
namespace modules {
|
namespace modules {
|
||||||
namespace finda {
|
namespace finda {
|
||||||
|
|
@ -8,7 +9,8 @@ namespace finda {
|
||||||
FINDA finda;
|
FINDA finda;
|
||||||
|
|
||||||
void FINDA::Step() {
|
void FINDA::Step() {
|
||||||
debounce::Debouncer::Step(mt::timebase.Millis(), hal::adc::ReadADC(config::findaADCIndex) > config::findaADCDecisionLevel);
|
|
||||||
|
debounce::Debouncer::Step(mt::timebase.Millis(), hal::gpio::ReadPin(FINDA_PIN) == hal::gpio::Level::high);
|
||||||
}
|
}
|
||||||
|
|
||||||
} // namespace finda
|
} // namespace finda
|
||||||
|
|
|
||||||
|
|
@ -25,3 +25,5 @@ static constexpr hal::gpio::GPIO_pin SELECTOR_STEP_PIN = { GPIOD, 4 };
|
||||||
static constexpr hal::gpio::GPIO_pin IDLER_CS_PIN = { GPIOB, 7 };
|
static constexpr hal::gpio::GPIO_pin IDLER_CS_PIN = { GPIOB, 7 };
|
||||||
static constexpr hal::gpio::GPIO_pin IDLER_SG_PIN = { GPIOF, 0 };
|
static constexpr hal::gpio::GPIO_pin IDLER_SG_PIN = { GPIOF, 0 };
|
||||||
static constexpr hal::gpio::GPIO_pin IDLER_STEP_PIN = { GPIOD, 6 };
|
static constexpr hal::gpio::GPIO_pin IDLER_STEP_PIN = { GPIOD, 6 };
|
||||||
|
|
||||||
|
static constexpr hal::gpio::GPIO_pin FINDA_PIN = { GPIOF, 6 }; /// PF6 A1 ADC6/TDI
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue