mirror of
https://github.com/DCC-EX/CommandStation-EX.git
synced 2024-11-30 03:26:13 +01:00
Turnouts: adjust the split of code between .h and .cpp file. No functional changes.
This commit is contained in:
parent
3e50a6bdad
commit
7b47b86143
|
@ -181,12 +181,16 @@ void PCA9685::_loop(unsigned long currentMicros) {
|
||||||
// TODO: Could calculate step number from elapsed time, to allow for erratic loop timing.
|
// TODO: Could calculate step number from elapsed time, to allow for erratic loop timing.
|
||||||
void PCA9685::updatePosition(uint8_t pin) {
|
void PCA9685::updatePosition(uint8_t pin) {
|
||||||
struct ServoData *s = _servoData[pin];
|
struct ServoData *s = _servoData[pin];
|
||||||
|
|
||||||
if (s == NULL) return; // No pin configuration/state data
|
if (s == NULL) return; // No pin configuration/state data
|
||||||
|
|
||||||
if (s->numSteps == 0) return; // No animation in progress
|
if (s->numSteps == 0) return; // No animation in progress
|
||||||
|
|
||||||
if (s->stepNumber == 0 && s->fromPosition == s->toPosition) {
|
if (s->stepNumber == 0 && s->fromPosition == s->toPosition) {
|
||||||
// Go straight to end of sequence, output final position.
|
// Go straight to end of sequence, output final position.
|
||||||
s->stepNumber = s->numSteps-1;
|
s->stepNumber = s->numSteps-1;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (s->stepNumber < s->numSteps) {
|
if (s->stepNumber < s->numSteps) {
|
||||||
// Animation in progress, reposition servo
|
// Animation in progress, reposition servo
|
||||||
s->stepNumber++;
|
s->stepNumber++;
|
||||||
|
|
307
Turnouts.cpp
307
Turnouts.cpp
|
@ -20,9 +20,6 @@
|
||||||
* along with CommandStation. If not, see <https://www.gnu.org/licenses/>.
|
* along with CommandStation. If not, see <https://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#ifndef TURNOUTS_CPP
|
|
||||||
#define TURNOUTS_CPP
|
|
||||||
|
|
||||||
// Set the following definition to true for <T id 0> = throw and <T id 1> = close
|
// Set the following definition to true for <T id 0> = throw and <T id 1> = close
|
||||||
// or to false for <T id 0> = close and <T id 1> = throw (the original way).
|
// or to false for <T id 0> = close and <T id 1> = throw (the original way).
|
||||||
#ifndef USE_LEGACY_TURNOUT_BEHAVIOUR
|
#ifndef USE_LEGACY_TURNOUT_BEHAVIOUR
|
||||||
|
@ -34,6 +31,8 @@
|
||||||
#include "StringFormatter.h"
|
#include "StringFormatter.h"
|
||||||
#include "RMFT2.h"
|
#include "RMFT2.h"
|
||||||
#include "Turnouts.h"
|
#include "Turnouts.h"
|
||||||
|
#include "DCC.h"
|
||||||
|
#include "LCN.h"
|
||||||
#ifdef EESTOREDEBUG
|
#ifdef EESTOREDEBUG
|
||||||
#include "DIAG.h"
|
#include "DIAG.h"
|
||||||
#endif
|
#endif
|
||||||
|
@ -106,6 +105,14 @@
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
bool Turnout::setClosedStateOnly(uint16_t id, bool close) {
|
||||||
|
Turnout *tt = get(id);
|
||||||
|
if (tt) return false;
|
||||||
|
tt->_turnoutData.closed = close;
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
// Static setClosed function is invoked from close(), throw() etc. to perform the
|
// Static setClosed function is invoked from close(), throw() etc. to perform the
|
||||||
// common parts of the turnout operation. Code which is specific to a turnout
|
// common parts of the turnout operation. Code which is specific to a turnout
|
||||||
// type should be placed in the virtual function setClosedInternal(bool) which is
|
// type should be placed in the virtual function setClosedInternal(bool) which is
|
||||||
|
@ -199,4 +206,298 @@
|
||||||
if (!tt) tt->printState(stream);
|
if (!tt) tt->printState(stream);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* ServoTurnout - Turnout controlled by servo device.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
|
||||||
|
// Private Constructor
|
||||||
|
ServoTurnout::ServoTurnout(uint16_t id, VPIN vpin, uint16_t thrownPosition, uint16_t closedPosition, uint8_t profile, bool closed) :
|
||||||
|
Turnout(id, TURNOUT_SERVO, closed)
|
||||||
|
{
|
||||||
|
_servoTurnoutData.vpin = vpin;
|
||||||
|
_servoTurnoutData.thrownPosition = thrownPosition;
|
||||||
|
_servoTurnoutData.closedPosition = closedPosition;
|
||||||
|
_servoTurnoutData.profile = profile;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Create function
|
||||||
|
Turnout *ServoTurnout::create(uint16_t id, VPIN vpin, uint16_t thrownPosition, uint16_t closedPosition, uint8_t profile, bool closed) {
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
Turnout *tt = get(id);
|
||||||
|
if (tt) {
|
||||||
|
// Object already exists, check if it is usable
|
||||||
|
if (tt->isType(TURNOUT_SERVO)) {
|
||||||
|
// Yes, so set parameters
|
||||||
|
ServoTurnout *st = (ServoTurnout *)tt;
|
||||||
|
st->_servoTurnoutData.vpin = vpin;
|
||||||
|
st->_servoTurnoutData.thrownPosition = thrownPosition;
|
||||||
|
st->_servoTurnoutData.closedPosition = closedPosition;
|
||||||
|
st->_servoTurnoutData.profile = profile;
|
||||||
|
// Don't touch the _closed parameter, retain the original value.
|
||||||
|
|
||||||
|
// We don't really need to do the following, since a call to IODevice::_writeAnalogue
|
||||||
|
// will provide all the data that is required!
|
||||||
|
// int params[] = {(int)thrownPosition, (int)closedPosition, profile, closed};
|
||||||
|
// IODevice::configure(vpin, IODevice::CONFIGURE_SERVO, 4, params);
|
||||||
|
|
||||||
|
// Set position directly to specified position - we don't know where it is moving from.
|
||||||
|
IODevice::writeAnalogue(vpin, closed ? closedPosition : thrownPosition, PCA9685::Instant);
|
||||||
|
|
||||||
|
return tt;
|
||||||
|
} else {
|
||||||
|
// Incompatible object, delete and recreate
|
||||||
|
remove(id);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
tt = (Turnout *)new ServoTurnout(id, vpin, thrownPosition, closedPosition, profile, closed);
|
||||||
|
IODevice::writeAnalogue(vpin, closed ? closedPosition : thrownPosition, PCA9685::Instant);
|
||||||
|
return tt;
|
||||||
|
#else
|
||||||
|
(void)id; (void)vpin; (void)thrownPosition; (void)closedPosition;
|
||||||
|
(void)profile; (void)closed; // avoid compiler warnings.
|
||||||
|
return NULL;
|
||||||
#endif
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
// Load a Servo turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
||||||
|
Turnout *ServoTurnout::load(struct TurnoutData *turnoutData) {
|
||||||
|
ServoTurnoutData servoTurnoutData;
|
||||||
|
// Read class-specific data from EEPROM
|
||||||
|
EEPROM.get(EEStore::pointer(), servoTurnoutData);
|
||||||
|
EEStore::advance(sizeof(servoTurnoutData));
|
||||||
|
|
||||||
|
// Create new object
|
||||||
|
Turnout *tt = ServoTurnout::create(turnoutData->id, servoTurnoutData.vpin, servoTurnoutData.thrownPosition,
|
||||||
|
servoTurnoutData.closedPosition, servoTurnoutData.profile, turnoutData->closed);
|
||||||
|
return tt;
|
||||||
|
}
|
||||||
|
|
||||||
|
void ServoTurnout::print(Print *stream) {
|
||||||
|
StringFormatter::send(stream, F("<H %d SERVO %d %d %d %d %d>\n"), _turnoutData.id, _servoTurnoutData.vpin,
|
||||||
|
_servoTurnoutData.thrownPosition, _servoTurnoutData.closedPosition, _servoTurnoutData.profile,
|
||||||
|
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
||||||
|
}
|
||||||
|
|
||||||
|
// ServoTurnout-specific code for throwing or closing a servo turnout.
|
||||||
|
bool ServoTurnout::setClosedInternal(bool close) {
|
||||||
|
#ifndef IO_NO_HAL
|
||||||
|
IODevice::writeAnalogue(_servoTurnoutData.vpin,
|
||||||
|
close ? _servoTurnoutData.closedPosition : _servoTurnoutData.thrownPosition, _servoTurnoutData.profile);
|
||||||
|
_turnoutData.closed = close;
|
||||||
|
#else
|
||||||
|
(void)close; // avoid compiler warnings
|
||||||
|
#endif
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
void ServoTurnout::save() {
|
||||||
|
// Write turnout definition and current position to EEPROM
|
||||||
|
// First write common servo data, then
|
||||||
|
// write the servo-specific data
|
||||||
|
EEPROM.put(EEStore::pointer(), _turnoutData);
|
||||||
|
EEStore::advance(sizeof(_turnoutData));
|
||||||
|
EEPROM.put(EEStore::pointer(), _servoTurnoutData);
|
||||||
|
EEStore::advance(sizeof(_servoTurnoutData));
|
||||||
|
}
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* DCCTurnout - Turnout controlled by DCC Accessory Controller.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
|
||||||
|
// DCCTurnoutData contains data specific to this subclass that is
|
||||||
|
// written to EEPROM when the turnout is saved.
|
||||||
|
struct DCCTurnoutData {
|
||||||
|
// DCC address (Address in bits 15-2, subaddress in bits 1-0
|
||||||
|
uint16_t address; // CS currently supports linear address 1-2048
|
||||||
|
// That's DCC accessory address 1-512 and subaddress 0-3.
|
||||||
|
} _dccTurnoutData; // 2 bytes
|
||||||
|
|
||||||
|
// Constructor
|
||||||
|
DCCTurnout::DCCTurnout(uint16_t id, uint16_t address, uint8_t subAdd) :
|
||||||
|
Turnout(id, TURNOUT_DCC, false)
|
||||||
|
{
|
||||||
|
_dccTurnoutData.address = ((address-1) << 2) + subAdd + 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Create function
|
||||||
|
Turnout *DCCTurnout::create(uint16_t id, uint16_t add, uint8_t subAdd) {
|
||||||
|
Turnout *tt = get(id);
|
||||||
|
if (tt) {
|
||||||
|
// Object already exists, check if it is usable
|
||||||
|
if (tt->isType(TURNOUT_DCC)) {
|
||||||
|
// Yes, so set parameters<T>
|
||||||
|
DCCTurnout *dt = (DCCTurnout *)tt;
|
||||||
|
dt->_dccTurnoutData.address = ((add-1) << 2) + subAdd + 1;
|
||||||
|
// Don't touch the _closed parameter, retain the original value.
|
||||||
|
return tt;
|
||||||
|
} else {
|
||||||
|
// Incompatible object, delete and recreate
|
||||||
|
remove(id);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
tt = (Turnout *)new DCCTurnout(id, add, subAdd);
|
||||||
|
return tt;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Load a DCC turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
||||||
|
Turnout *DCCTurnout::load(struct TurnoutData *turnoutData) {
|
||||||
|
DCCTurnoutData dccTurnoutData;
|
||||||
|
// Read class-specific data from EEPROM
|
||||||
|
EEPROM.get(EEStore::pointer(), dccTurnoutData);
|
||||||
|
EEStore::advance(sizeof(dccTurnoutData));
|
||||||
|
|
||||||
|
// Create new object
|
||||||
|
DCCTurnout *tt = new DCCTurnout(turnoutData->id, (((dccTurnoutData.address-1) >> 2)+1), ((dccTurnoutData.address-1) & 3));
|
||||||
|
|
||||||
|
return tt;
|
||||||
|
}
|
||||||
|
|
||||||
|
void DCCTurnout::print(Print *stream) {
|
||||||
|
StringFormatter::send(stream, F("<H %d DCC %d %d %d>\n"), _turnoutData.id,
|
||||||
|
(((_dccTurnoutData.address-1) >> 2)+1), ((_dccTurnoutData.address-1) & 3),
|
||||||
|
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
||||||
|
// Also report using classic DCC++ syntax for DCC accessory turnouts
|
||||||
|
StringFormatter::send(stream, F("<H %d %d %d %d>\n"), _turnoutData.id,
|
||||||
|
(((_dccTurnoutData.address-1) >> 2)+1), ((_dccTurnoutData.address-1) & 3),
|
||||||
|
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
||||||
|
}
|
||||||
|
|
||||||
|
bool DCCTurnout::setClosedInternal(bool close) {
|
||||||
|
// DCC++ Classic behaviour is that Throw writes a 1 in the packet,
|
||||||
|
// and Close writes a 0.
|
||||||
|
// RCN-214 specifies that Throw is 0 and Close is 1.
|
||||||
|
DCC::setAccessory((((_dccTurnoutData.address-1) >> 2) + 1),
|
||||||
|
((_dccTurnoutData.address-1) & 3), close ^ useLegacyTurnoutBehaviour);
|
||||||
|
_turnoutData.closed = close;
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
void DCCTurnout::save() {
|
||||||
|
// Write turnout definition and current position to EEPROM
|
||||||
|
// First write common servo data, then
|
||||||
|
// write the servo-specific data
|
||||||
|
EEPROM.put(EEStore::pointer(), _turnoutData);
|
||||||
|
EEStore::advance(sizeof(_turnoutData));
|
||||||
|
EEPROM.put(EEStore::pointer(), _dccTurnoutData);
|
||||||
|
EEStore::advance(sizeof(_dccTurnoutData));
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* VpinTurnout - Turnout controlled through a HAL vpin.
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
|
||||||
|
// Constructor
|
||||||
|
VpinTurnout::VpinTurnout(uint16_t id, VPIN vpin, bool closed) :
|
||||||
|
Turnout(id, TURNOUT_VPIN, closed)
|
||||||
|
{
|
||||||
|
_vpinTurnoutData.vpin = vpin;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Create function
|
||||||
|
Turnout *VpinTurnout::create(uint16_t id, VPIN vpin, bool closed) {
|
||||||
|
Turnout *tt = get(id);
|
||||||
|
if (tt) {
|
||||||
|
// Object already exists, check if it is usable
|
||||||
|
if (tt->isType(TURNOUT_VPIN)) {
|
||||||
|
// Yes, so set parameters
|
||||||
|
VpinTurnout *vt = (VpinTurnout *)tt;
|
||||||
|
vt->_vpinTurnoutData.vpin = vpin;
|
||||||
|
// Don't touch the _closed parameter, retain the original value.
|
||||||
|
return tt;
|
||||||
|
} else {
|
||||||
|
// Incompatible object, delete and recreate
|
||||||
|
remove(id);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
tt = (Turnout *)new VpinTurnout(id, vpin, closed);
|
||||||
|
return tt;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Load a VPIN turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
||||||
|
Turnout *VpinTurnout::load(struct TurnoutData *turnoutData) {
|
||||||
|
VpinTurnoutData vpinTurnoutData;
|
||||||
|
// Read class-specific data from EEPROM
|
||||||
|
EEPROM.get(EEStore::pointer(), vpinTurnoutData);
|
||||||
|
EEStore::advance(sizeof(vpinTurnoutData));
|
||||||
|
|
||||||
|
// Create new object
|
||||||
|
VpinTurnout *tt = new VpinTurnout(turnoutData->id, vpinTurnoutData.vpin, turnoutData->closed);
|
||||||
|
|
||||||
|
return tt;
|
||||||
|
}
|
||||||
|
|
||||||
|
void VpinTurnout::print(Print *stream) {
|
||||||
|
StringFormatter::send(stream, F("<H %d VPIN %d %d>\n"), _turnoutData.id, _vpinTurnoutData.vpin,
|
||||||
|
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
||||||
|
}
|
||||||
|
|
||||||
|
bool VpinTurnout::setClosedInternal(bool close) {
|
||||||
|
IODevice::write(_vpinTurnoutData.vpin, close);
|
||||||
|
_turnoutData.closed = close;
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
void VpinTurnout::save() {
|
||||||
|
// Write turnout definition and current position to EEPROM
|
||||||
|
// First write common servo data, then
|
||||||
|
// write the servo-specific data
|
||||||
|
EEPROM.put(EEStore::pointer(), _turnoutData);
|
||||||
|
EEStore::advance(sizeof(_turnoutData));
|
||||||
|
EEPROM.put(EEStore::pointer(), _vpinTurnoutData);
|
||||||
|
EEStore::advance(sizeof(_vpinTurnoutData));
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/*************************************************************************************
|
||||||
|
* LCNTurnout - Turnout controlled by Loconet
|
||||||
|
*
|
||||||
|
*************************************************************************************/
|
||||||
|
|
||||||
|
// LCNTurnout has no specific data, and in any case is not written to EEPROM!
|
||||||
|
// struct LCNTurnoutData {
|
||||||
|
// } _lcnTurnoutData; // 0 bytes
|
||||||
|
|
||||||
|
// Constructor
|
||||||
|
LCNTurnout::LCNTurnout(uint16_t id, bool closed) :
|
||||||
|
Turnout(id, TURNOUT_LCN, closed)
|
||||||
|
{ }
|
||||||
|
|
||||||
|
// Create function
|
||||||
|
Turnout *LCNTurnout::create(uint16_t id, bool closed) {
|
||||||
|
Turnout *tt = get(id);
|
||||||
|
if (tt) {
|
||||||
|
// Object already exists, check if it is usable
|
||||||
|
if (tt->isType(TURNOUT_LCN)) {
|
||||||
|
// Yes, so return this object
|
||||||
|
return tt;
|
||||||
|
} else {
|
||||||
|
// Incompatible object, delete and recreate
|
||||||
|
remove(id);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
tt = (Turnout *)new LCNTurnout(id, closed);
|
||||||
|
return tt;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool LCNTurnout::setClosedInternal(bool close) {
|
||||||
|
// Assume that the LCN command still uses 1 for throw and 0 for close...
|
||||||
|
LCN::send('T', _turnoutData.id, !close);
|
||||||
|
// The _turnoutData.closed flag should be updated by a message from the LCN master, later.
|
||||||
|
return true;
|
||||||
|
}
|
||||||
|
|
||||||
|
// LCN turnouts not saved to EEPROM.
|
||||||
|
//void save() override { }
|
||||||
|
//static Turnout *load(struct TurnoutData *turnoutData) {
|
||||||
|
|
||||||
|
void LCNTurnout::print(Print *stream) {
|
||||||
|
StringFormatter::send(stream, F("<H %d LCN %d>\n"), _turnoutData.id,
|
||||||
|
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
272
Turnouts.h
272
Turnouts.h
|
@ -19,18 +19,13 @@
|
||||||
* along with CommandStation. If not, see <https://www.gnu.org/licenses/>.
|
* along with CommandStation. If not, see <https://www.gnu.org/licenses/>.
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#ifndef TURNOUTS_H
|
||||||
|
#define TURNOUTS_H
|
||||||
|
|
||||||
//#define EESTOREDEBUG
|
//#define EESTOREDEBUG
|
||||||
#include "defines.h"
|
#include "Arduino.h"
|
||||||
#include "EEStore.h"
|
#include "IODevice.h"
|
||||||
#include "StringFormatter.h"
|
|
||||||
#include "RMFT2.h"
|
|
||||||
#ifdef EESTOREDEBUG
|
|
||||||
#include "DIAG.h"
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#include "DCC.h"
|
|
||||||
#include "LCN.h"
|
|
||||||
|
|
||||||
// Turnout type definitions
|
// Turnout type definitions
|
||||||
enum {
|
enum {
|
||||||
|
@ -154,12 +149,7 @@ public:
|
||||||
return setClosed(id, false);
|
return setClosed(id, false);
|
||||||
}
|
}
|
||||||
|
|
||||||
static bool setClosedStateOnly(uint16_t id, bool close) {
|
static bool setClosedStateOnly(uint16_t id, bool close);
|
||||||
Turnout *tt = get(id);
|
|
||||||
if (tt) return false;
|
|
||||||
tt->_turnoutData.closed = close;
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
inline static Turnout *first() { return _firstTurnout; }
|
inline static Turnout *first() { return _firstTurnout; }
|
||||||
|
|
||||||
|
@ -195,96 +185,21 @@ private:
|
||||||
} _servoTurnoutData; // 6 bytes
|
} _servoTurnoutData; // 6 bytes
|
||||||
|
|
||||||
// Constructor
|
// Constructor
|
||||||
ServoTurnout(uint16_t id, VPIN vpin, uint16_t thrownPosition, uint16_t closedPosition, uint8_t profile, bool closed = true) :
|
ServoTurnout(uint16_t id, VPIN vpin, uint16_t thrownPosition, uint16_t closedPosition, uint8_t profile, bool closed = true);
|
||||||
Turnout(id, TURNOUT_SERVO, closed)
|
|
||||||
{
|
|
||||||
_servoTurnoutData.vpin = vpin;
|
|
||||||
_servoTurnoutData.thrownPosition = thrownPosition;
|
|
||||||
_servoTurnoutData.closedPosition = closedPosition;
|
|
||||||
_servoTurnoutData.profile = profile;
|
|
||||||
}
|
|
||||||
|
|
||||||
public:
|
public:
|
||||||
// Create function
|
// Create function
|
||||||
static Turnout *create(uint16_t id, VPIN vpin, uint16_t thrownPosition, uint16_t closedPosition, uint8_t profile, bool closed = true) {
|
static Turnout *create(uint16_t id, VPIN vpin, uint16_t thrownPosition, uint16_t closedPosition, uint8_t profile, bool closed = true);
|
||||||
#ifndef IO_NO_HAL
|
|
||||||
Turnout *tt = get(id);
|
|
||||||
if (tt) {
|
|
||||||
// Object already exists, check if it is usable
|
|
||||||
if (tt->isType(TURNOUT_SERVO)) {
|
|
||||||
// Yes, so set parameters
|
|
||||||
ServoTurnout *st = (ServoTurnout *)tt;
|
|
||||||
st->_servoTurnoutData.vpin = vpin;
|
|
||||||
st->_servoTurnoutData.thrownPosition = thrownPosition;
|
|
||||||
st->_servoTurnoutData.closedPosition = closedPosition;
|
|
||||||
st->_servoTurnoutData.profile = profile;
|
|
||||||
// Don't touch the _closed parameter, retain the original value.
|
|
||||||
|
|
||||||
// We don't really need to do the following, since a call to IODevice::_writeAnalogue
|
|
||||||
// will provide all the data that is required!
|
|
||||||
// int params[] = {(int)thrownPosition, (int)closedPosition, profile, closed};
|
|
||||||
// IODevice::configure(vpin, IODevice::CONFIGURE_SERVO, 4, params);
|
|
||||||
|
|
||||||
// Set position directly to specified position - we don't know where it is moving from.
|
|
||||||
IODevice::writeAnalogue(vpin, closed ? closedPosition : thrownPosition, PCA9685::Instant);
|
|
||||||
|
|
||||||
return tt;
|
|
||||||
} else {
|
|
||||||
// Incompatible object, delete and recreate
|
|
||||||
remove(id);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
tt = (Turnout *)new ServoTurnout(id, vpin, thrownPosition, closedPosition, profile, closed);
|
|
||||||
IODevice::writeAnalogue(vpin, closed ? closedPosition : thrownPosition, PCA9685::Instant);
|
|
||||||
return tt;
|
|
||||||
#else
|
|
||||||
(void)id; (void)vpin; (void)thrownPosition; (void)closedPosition;
|
|
||||||
(void)profile; (void)closed; // avoid compiler warnings.
|
|
||||||
return NULL;
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
// Load a Servo turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
// Load a Servo turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
||||||
static Turnout *load(struct TurnoutData *turnoutData) {
|
static Turnout *load(struct TurnoutData *turnoutData);
|
||||||
ServoTurnoutData servoTurnoutData;
|
void print(Print *stream) override;
|
||||||
// Read class-specific data from EEPROM
|
|
||||||
EEPROM.get(EEStore::pointer(), servoTurnoutData);
|
|
||||||
EEStore::advance(sizeof(servoTurnoutData));
|
|
||||||
|
|
||||||
// Create new object
|
|
||||||
Turnout *tt = ServoTurnout::create(turnoutData->id, servoTurnoutData.vpin, servoTurnoutData.thrownPosition,
|
|
||||||
servoTurnoutData.closedPosition, servoTurnoutData.profile, turnoutData->closed);
|
|
||||||
return tt;
|
|
||||||
}
|
|
||||||
|
|
||||||
void print(Print *stream) override {
|
|
||||||
StringFormatter::send(stream, F("<H %d SERVO %d %d %d %d %d>\n"), _turnoutData.id, _servoTurnoutData.vpin,
|
|
||||||
_servoTurnoutData.thrownPosition, _servoTurnoutData.closedPosition, _servoTurnoutData.profile,
|
|
||||||
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
|
||||||
}
|
|
||||||
|
|
||||||
protected:
|
protected:
|
||||||
// ServoTurnout-specific code for throwing or closing a servo turnout.
|
// ServoTurnout-specific code for throwing or closing a servo turnout.
|
||||||
bool setClosedInternal(bool close) override {
|
bool setClosedInternal(bool close) override;
|
||||||
#ifndef IO_NO_HAL
|
void save() override;
|
||||||
IODevice::writeAnalogue(_servoTurnoutData.vpin,
|
|
||||||
close ? _servoTurnoutData.closedPosition : _servoTurnoutData.thrownPosition, _servoTurnoutData.profile);
|
|
||||||
_turnoutData.closed = close;
|
|
||||||
#else
|
|
||||||
(void)close; // avoid compiler warnings
|
|
||||||
#endif
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
void save() override {
|
|
||||||
// Write turnout definition and current position to EEPROM
|
|
||||||
// First write common servo data, then
|
|
||||||
// write the servo-specific data
|
|
||||||
EEPROM.put(EEStore::pointer(), _turnoutData);
|
|
||||||
EEStore::advance(sizeof(_turnoutData));
|
|
||||||
EEPROM.put(EEStore::pointer(), _servoTurnoutData);
|
|
||||||
EEStore::advance(sizeof(_servoTurnoutData));
|
|
||||||
}
|
|
||||||
};
|
};
|
||||||
|
|
||||||
/*************************************************************************************
|
/*************************************************************************************
|
||||||
|
@ -302,76 +217,18 @@ private:
|
||||||
} _dccTurnoutData; // 2 bytes
|
} _dccTurnoutData; // 2 bytes
|
||||||
|
|
||||||
// Constructor
|
// Constructor
|
||||||
DCCTurnout(uint16_t id, uint16_t address, uint8_t subAdd) :
|
DCCTurnout(uint16_t id, uint16_t address, uint8_t subAdd);
|
||||||
Turnout(id, TURNOUT_DCC, false)
|
|
||||||
{
|
|
||||||
_dccTurnoutData.address = ((address-1) << 2) + subAdd + 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
public:
|
public:
|
||||||
// Create function
|
// Create function
|
||||||
static Turnout *create(uint16_t id, uint16_t add, uint8_t subAdd) {
|
static Turnout *create(uint16_t id, uint16_t add, uint8_t subAdd);
|
||||||
Turnout *tt = get(id);
|
// Load a VPIN turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
||||||
if (tt) {
|
static Turnout *load(struct TurnoutData *turnoutData);
|
||||||
// Object already exists, check if it is usable
|
void print(Print *stream) override;
|
||||||
if (tt->isType(TURNOUT_DCC)) {
|
|
||||||
// Yes, so set parameters<T>
|
|
||||||
DCCTurnout *dt = (DCCTurnout *)tt;
|
|
||||||
dt->_dccTurnoutData.address = ((add-1) << 2) + subAdd + 1;
|
|
||||||
// Don't touch the _closed parameter, retain the original value.
|
|
||||||
return tt;
|
|
||||||
} else {
|
|
||||||
// Incompatible object, delete and recreate
|
|
||||||
remove(id);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
tt = (Turnout *)new DCCTurnout(id, add, subAdd);
|
|
||||||
return tt;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Load a DCC turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
|
||||||
static Turnout *load(struct TurnoutData *turnoutData) {
|
|
||||||
DCCTurnoutData dccTurnoutData;
|
|
||||||
// Read class-specific data from EEPROM
|
|
||||||
EEPROM.get(EEStore::pointer(), dccTurnoutData);
|
|
||||||
EEStore::advance(sizeof(dccTurnoutData));
|
|
||||||
|
|
||||||
// Create new object
|
|
||||||
DCCTurnout *tt = new DCCTurnout(turnoutData->id, (((dccTurnoutData.address-1) >> 2)+1), ((dccTurnoutData.address-1) & 3));
|
|
||||||
|
|
||||||
return tt;
|
|
||||||
}
|
|
||||||
|
|
||||||
void print(Print *stream) override {
|
|
||||||
StringFormatter::send(stream, F("<H %d DCC %d %d %d>\n"), _turnoutData.id,
|
|
||||||
(((_dccTurnoutData.address-1) >> 2)+1), ((_dccTurnoutData.address-1) & 3),
|
|
||||||
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
|
||||||
// Also report using classic DCC++ syntax for DCC accessory turnouts
|
|
||||||
StringFormatter::send(stream, F("<H %d %d %d %d>\n"), _turnoutData.id,
|
|
||||||
(((_dccTurnoutData.address-1) >> 2)+1), ((_dccTurnoutData.address-1) & 3),
|
|
||||||
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
|
||||||
}
|
|
||||||
|
|
||||||
protected:
|
protected:
|
||||||
bool setClosedInternal(bool close) override {
|
bool setClosedInternal(bool close) override;
|
||||||
// DCC++ Classic behaviour is that Throw writes a 1 in the packet,
|
void save() override;
|
||||||
// and Close writes a 0.
|
|
||||||
// RCN-214 specifies that Throw is 0 and Close is 1.
|
|
||||||
DCC::setAccessory((((_dccTurnoutData.address-1) >> 2) + 1),
|
|
||||||
((_dccTurnoutData.address-1) & 3), close ^ useLegacyTurnoutBehaviour);
|
|
||||||
_turnoutData.closed = close;
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
void save() override {
|
|
||||||
// Write turnout definition and current position to EEPROM
|
|
||||||
// First write common servo data, then
|
|
||||||
// write the servo-specific data
|
|
||||||
EEPROM.put(EEStore::pointer(), _turnoutData);
|
|
||||||
EEStore::advance(sizeof(_turnoutData));
|
|
||||||
EEPROM.put(EEStore::pointer(), _dccTurnoutData);
|
|
||||||
EEStore::advance(sizeof(_dccTurnoutData));
|
|
||||||
}
|
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
|
@ -389,67 +246,20 @@ private:
|
||||||
} _vpinTurnoutData; // 2 bytes
|
} _vpinTurnoutData; // 2 bytes
|
||||||
|
|
||||||
// Constructor
|
// Constructor
|
||||||
VpinTurnout(uint16_t id, VPIN vpin, bool closed=true) :
|
VpinTurnout(uint16_t id, VPIN vpin, bool closed=true);
|
||||||
Turnout(id, TURNOUT_VPIN, closed)
|
|
||||||
{
|
|
||||||
_vpinTurnoutData.vpin = vpin;
|
|
||||||
}
|
|
||||||
|
|
||||||
public:
|
public:
|
||||||
// Create function
|
// Create function
|
||||||
static Turnout *create(uint16_t id, VPIN vpin, bool closed=true) {
|
static Turnout *create(uint16_t id, VPIN vpin, bool closed=true);
|
||||||
Turnout *tt = get(id);
|
|
||||||
if (tt) {
|
|
||||||
// Object already exists, check if it is usable
|
|
||||||
if (tt->isType(TURNOUT_VPIN)) {
|
|
||||||
// Yes, so set parameters
|
|
||||||
VpinTurnout *vt = (VpinTurnout *)tt;
|
|
||||||
vt->_vpinTurnoutData.vpin = vpin;
|
|
||||||
// Don't touch the _closed parameter, retain the original value.
|
|
||||||
return tt;
|
|
||||||
} else {
|
|
||||||
// Incompatible object, delete and recreate
|
|
||||||
remove(id);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
tt = (Turnout *)new VpinTurnout(id, vpin, closed);
|
|
||||||
return tt;
|
|
||||||
}
|
|
||||||
|
|
||||||
// Load a VPIN turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
// Load a VPIN turnout definition from EEPROM. The common Turnout data has already been read at this point.
|
||||||
static Turnout *load(struct TurnoutData *turnoutData) {
|
static Turnout *load(struct TurnoutData *turnoutData);
|
||||||
VpinTurnoutData vpinTurnoutData;
|
void print(Print *stream) override;
|
||||||
// Read class-specific data from EEPROM
|
|
||||||
EEPROM.get(EEStore::pointer(), vpinTurnoutData);
|
|
||||||
EEStore::advance(sizeof(vpinTurnoutData));
|
|
||||||
|
|
||||||
// Create new object
|
|
||||||
VpinTurnout *tt = new VpinTurnout(turnoutData->id, vpinTurnoutData.vpin, turnoutData->closed);
|
|
||||||
|
|
||||||
return tt;
|
|
||||||
}
|
|
||||||
|
|
||||||
void print(Print *stream) override {
|
|
||||||
StringFormatter::send(stream, F("<H %d VPIN %d %d>\n"), _turnoutData.id, _vpinTurnoutData.vpin,
|
|
||||||
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
|
||||||
}
|
|
||||||
|
|
||||||
protected:
|
protected:
|
||||||
bool setClosedInternal(bool close) override {
|
bool setClosedInternal(bool close) override;
|
||||||
IODevice::write(_vpinTurnoutData.vpin, close);
|
void save() override;
|
||||||
_turnoutData.closed = close;
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
void save() override {
|
|
||||||
// Write turnout definition and current position to EEPROM
|
|
||||||
// First write common servo data, then
|
|
||||||
// write the servo-specific data
|
|
||||||
EEPROM.put(EEStore::pointer(), _turnoutData);
|
|
||||||
EEStore::advance(sizeof(_turnoutData));
|
|
||||||
EEPROM.put(EEStore::pointer(), _vpinTurnoutData);
|
|
||||||
EEStore::advance(sizeof(_vpinTurnoutData));
|
|
||||||
}
|
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
||||||
|
@ -464,43 +274,21 @@ private:
|
||||||
// } _lcnTurnoutData; // 0 bytes
|
// } _lcnTurnoutData; // 0 bytes
|
||||||
|
|
||||||
// Constructor
|
// Constructor
|
||||||
LCNTurnout(uint16_t id, bool closed=true) :
|
LCNTurnout(uint16_t id, bool closed=true);
|
||||||
Turnout(id, TURNOUT_LCN, closed)
|
|
||||||
{ }
|
|
||||||
|
|
||||||
public:
|
public:
|
||||||
// Create function
|
// Create function
|
||||||
static Turnout *create(uint16_t id, bool closed=true) {
|
static Turnout *create(uint16_t id, bool closed=true);
|
||||||
Turnout *tt = get(id);
|
|
||||||
if (tt) {
|
|
||||||
// Object already exists, check if it is usable
|
|
||||||
if (tt->isType(TURNOUT_LCN)) {
|
|
||||||
// Yes, so return this object
|
|
||||||
return tt;
|
|
||||||
} else {
|
|
||||||
// Incompatible object, delete and recreate
|
|
||||||
remove(id);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
tt = (Turnout *)new LCNTurnout(id, closed);
|
|
||||||
return tt;
|
|
||||||
}
|
|
||||||
|
|
||||||
bool setClosedInternal(bool close) override {
|
|
||||||
// Assume that the LCN command still uses 1 for throw and 0 for close...
|
bool setClosedInternal(bool close) override;
|
||||||
LCN::send('T', _turnoutData.id, !close);
|
|
||||||
// The _turnoutData.closed flag should be updated by a message from the LCN master, later.
|
|
||||||
return true;
|
|
||||||
}
|
|
||||||
|
|
||||||
// LCN turnouts not saved to EEPROM.
|
// LCN turnouts not saved to EEPROM.
|
||||||
//void save() override { }
|
//void save() override { }
|
||||||
//static Turnout *load(struct TurnoutData *turnoutData) {
|
//static Turnout *load(struct TurnoutData *turnoutData) {
|
||||||
|
|
||||||
void print(Print *stream) override {
|
void print(Print *stream) override;
|
||||||
StringFormatter::send(stream, F("<H %d LCN %d>\n"), _turnoutData.id,
|
|
||||||
_turnoutData.closed ^ useLegacyTurnoutBehaviour);
|
|
||||||
}
|
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
Loading…
Reference in New Issue
Block a user