mirror of
https://github.com/DCC-EX/CommandStation-EX.git
synced 2024-11-23 08:06:13 +01:00
77 lines
2.5 KiB
C++
77 lines
2.5 KiB
C++
#include <Arduino.h>
|
|
#include <TimerOne.h> // use IDE menu Tools..Manage Libraries to locate and install TimerOne
|
|
#include "avdweb_AnalogReadFast.h"
|
|
#include "Hardware.h"
|
|
#include "Config.h"
|
|
#include "DIAG.h"
|
|
|
|
|
|
#if defined(ARDUINO_ARCH_AVR)
|
|
#include <DIO2.h> // use IDE menu Tools..Manage Libraries to locate and install DIO2
|
|
#define WritePin digitalWrite2
|
|
#else
|
|
#define WritePin digitalWrite
|
|
#endif
|
|
|
|
void Hardware::init() {
|
|
pinMode(MAIN_POWER_PIN, OUTPUT);
|
|
pinMode(MAIN_BRAKE_PIN, OUTPUT);
|
|
pinMode(MAIN_SIGNAL_PIN, OUTPUT);
|
|
if (MAIN_SIGNAL_PIN_ALT) pinMode(MAIN_SIGNAL_PIN_ALT, OUTPUT);
|
|
pinMode(MAIN_SENSE_PIN, INPUT);
|
|
|
|
pinMode(PROG_POWER_PIN, OUTPUT);
|
|
pinMode(PROG_BRAKE_PIN, OUTPUT);
|
|
pinMode(PROG_SIGNAL_PIN, OUTPUT);
|
|
if (PROG_SIGNAL_PIN_ALT) pinMode(PROG_SIGNAL_PIN_ALT, OUTPUT);
|
|
pinMode(PROG_SENSE_PIN, INPUT);
|
|
}
|
|
|
|
void Hardware::setPower(bool isMainTrack, bool on) {
|
|
WritePin(isMainTrack ? MAIN_POWER_PIN : PROG_POWER_PIN, on ? HIGH : LOW);
|
|
}
|
|
void Hardware::setBrake(bool isMainTrack, bool on) {
|
|
WritePin(isMainTrack ? MAIN_BRAKE_PIN : PROG_BRAKE_PIN, on ? LOW:HIGH);
|
|
}
|
|
|
|
void Hardware::setSignal(bool isMainTrack, bool high) {
|
|
byte pin = isMainTrack ? MAIN_SIGNAL_PIN : PROG_SIGNAL_PIN;
|
|
byte pin2 = isMainTrack ? MAIN_SIGNAL_PIN_ALT : PROG_SIGNAL_PIN_ALT;
|
|
WritePin(pin, high ? HIGH : LOW);
|
|
if (pin2) WritePin(pin2, high ? LOW : HIGH);
|
|
}
|
|
|
|
int Hardware::getCurrentMilliamps(bool isMainTrack) {
|
|
byte pin = isMainTrack ? MAIN_SENSE_PIN : PROG_SENSE_PIN;
|
|
float factor = isMainTrack ? MAIN_SENSE_FACTOR : PROG_SENSE_FACTOR;
|
|
|
|
// IMPORTANT: This function can be called in Interrupt() time within the 56uS timer
|
|
// The default analogRead takes ~100uS which is catastrphic
|
|
// so analogReadFast is used here. (-2uS)
|
|
int rawCurrent = analogReadFast(pin);
|
|
|
|
return (int)(rawCurrent * factor);
|
|
}
|
|
|
|
void Hardware::setCallback(int duration, void (*isr)()) {
|
|
Timer1.initialize(duration);
|
|
// We don't want the timer to set pins because these often clash with motor shields etc.
|
|
Timer1.disablePwm(TIMER1_A_PIN);
|
|
Timer1.disablePwm(TIMER1_B_PIN);
|
|
Timer1.attachInterrupt(isr);
|
|
}
|
|
|
|
|
|
// Railcom support functions, not yet implemented
|
|
//void Hardware::setSingleCallback(int duration, void (*isr)()) {
|
|
// Timer2.initialize(duration);
|
|
// Timer2.disablePwm(TIMER1_A_PIN);
|
|
// Timer2.disablePwm(TIMER1_B_PIN);
|
|
// Timer2.attachInterrupt(isr);
|
|
//}
|
|
|
|
//void Hardware::resetSingleCallback(int duration) {
|
|
// if (duration==0) Timer2.stop();
|
|
// else Timer2.initialize(duration);
|
|
//}
|