mirror of
https://github.com/DCC-EX/CommandStation-EX.git
synced 2024-11-25 00:56:13 +01:00
Compare commits
2 Commits
6cad794411
...
dbf053858b
Author | SHA1 | Date | |
---|---|---|---|
|
dbf053858b | ||
|
232ac993ec |
|
@ -98,6 +98,7 @@ const int16_t HASH_KEYWORD_WIFI = -5583;
|
||||||
const int16_t HASH_KEYWORD_ETHERNET = -30767;
|
const int16_t HASH_KEYWORD_ETHERNET = -30767;
|
||||||
const int16_t HASH_KEYWORD_WIT = 31594;
|
const int16_t HASH_KEYWORD_WIT = 31594;
|
||||||
const int16_t HASH_KEYWORD_EXTT = 8573;
|
const int16_t HASH_KEYWORD_EXTT = 8573;
|
||||||
|
const int16_t HASH_KEYWORD_ADD = 3201;
|
||||||
|
|
||||||
int16_t DCCEXParser::stashP[MAX_COMMAND_PARAMS];
|
int16_t DCCEXParser::stashP[MAX_COMMAND_PARAMS];
|
||||||
bool DCCEXParser::stashBusy;
|
bool DCCEXParser::stashBusy;
|
||||||
|
@ -714,7 +715,7 @@ void DCCEXParser::parseOne(Print *stream, byte *com, RingStream * ringStream)
|
||||||
// todesc = RMFT2::getTurntableDescription(id);
|
// todesc = RMFT2::getTurntableDescription(id);
|
||||||
#endif
|
#endif
|
||||||
if (todesc == NULL) todesc = F("");
|
if (todesc == NULL) todesc = F("");
|
||||||
StringFormatter::send(stream, F(" %d %d %d %d"), id, type, pos, posCount);
|
StringFormatter::send(stream, F(" %d %d %d"), id, type, pos);
|
||||||
for (uint8_t p = 0; p < posCount; p++) {
|
for (uint8_t p = 0; p < posCount; p++) {
|
||||||
int16_t value = tto->getPositionValue(p);
|
int16_t value = tto->getPositionValue(p);
|
||||||
StringFormatter::send(stream, F(" %d"), value);
|
StringFormatter::send(stream, F(" %d"), value);
|
||||||
|
@ -1059,10 +1060,12 @@ bool DCCEXParser::parseD(Print *stream, int16_t params, int16_t p[])
|
||||||
// ==========================
|
// ==========================
|
||||||
// Turntable - no support if no HAL
|
// Turntable - no support if no HAL
|
||||||
// <I> - list all
|
// <I> - list all
|
||||||
|
// <I id> - broadcast type and current position
|
||||||
|
// <I id DCC> - create DCC - This is TBA
|
||||||
// <I id steps> - operate (DCC)
|
// <I id steps> - operate (DCC)
|
||||||
// <I id steps activity> - operate (EXTT)
|
// <I id steps activity> - operate (EXTT)
|
||||||
// <I id EXTT i2caddress vpin position1 position2 ...> - create EXTT
|
// <I id ADD position value> - add position
|
||||||
// <I id DCC linear1 linear2 ...> - create DCC? - This TBA
|
// <I id EXTT i2caddress vpin home> - create EXTT
|
||||||
#ifndef IO_NO_HAL
|
#ifndef IO_NO_HAL
|
||||||
bool DCCEXParser::parseI(Print *stream, int16_t params, int16_t p[])
|
bool DCCEXParser::parseI(Print *stream, int16_t params, int16_t p[])
|
||||||
{
|
{
|
||||||
|
@ -1071,11 +1074,14 @@ bool DCCEXParser::parseI(Print *stream, int16_t params, int16_t p[])
|
||||||
case 0: // <I> list turntable objects
|
case 0: // <I> list turntable objects
|
||||||
return Turntable::printAll(stream);
|
return Turntable::printAll(stream);
|
||||||
|
|
||||||
case 1: // <I id> nothing here for the moment at least
|
case 1: // <I id> broadcast type and current position
|
||||||
return false;
|
return false;
|
||||||
|
|
||||||
case 2: // <I id position> - rotate to position for DCC turntables
|
case 2: // <I id position> - rotate to position for DCC turntables
|
||||||
{
|
{
|
||||||
|
if (p[1] == HASH_KEYWORD_DCC) { // Create a DCC turntable
|
||||||
|
DIAG(F("Create DCC turntable %d"), p[0]);
|
||||||
|
} else { // Otherwise move a DCC turntable
|
||||||
Turntable *tto = Turntable::get(p[0]);
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
if (tto) {
|
if (tto) {
|
||||||
if (tto->getPosition() == p[1]) return true;
|
if (tto->getPosition() == p[1]) return true;
|
||||||
|
@ -1089,10 +1095,20 @@ bool DCCEXParser::parseI(Print *stream, int16_t params, int16_t p[])
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
}
|
||||||
return true;
|
return true;
|
||||||
|
|
||||||
case 3: // <I id position activity> rotate to position for EX-Turntable
|
case 3:
|
||||||
{
|
{
|
||||||
|
if (p[1] == HASH_KEYWORD_ADD) { // <I id ADD value> add position value to turntable
|
||||||
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
|
if (tto) {
|
||||||
|
tto->addPosition(p[2]);
|
||||||
|
StringFormatter::send(stream, F("<i>\n"));
|
||||||
|
} else {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
} else { // <I id position activity> rotate to position for EX-Turntable
|
||||||
Turntable *tto = Turntable::get(p[0]);
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
if (tto) {
|
if (tto) {
|
||||||
if (!tto->setPosition(p[0], p[1], p[2])) return false;
|
if (!tto->setPosition(p[0], p[1], p[2])) return false;
|
||||||
|
@ -1100,18 +1116,16 @@ bool DCCEXParser::parseI(Print *stream, int16_t params, int16_t p[])
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
}
|
||||||
return true;
|
return true;
|
||||||
|
|
||||||
default: // If we're here, it must be creating a turntable object
|
case 5: // <I id EXTT vpin i2caddress home> create an EXTT turntable
|
||||||
{
|
{
|
||||||
if (params > 5 && params < 41 && p[1] == HASH_KEYWORD_EXTT) {
|
if (p[1] == HASH_KEYWORD_EXTT) {
|
||||||
if (Turntable::get(p[0])) return false;
|
if (Turntable::get(p[0])) return false;
|
||||||
if (!EXTTTurntable::create(p[0], (VPIN)p[2], (uint8_t)p[3])) return false;
|
if (!EXTTTurntable::create(p[0], (VPIN)p[2], (uint8_t)p[3])) return false;
|
||||||
Turntable *tto = Turntable::get(p[0]);
|
Turntable *tto = Turntable::get(p[0]);
|
||||||
for (uint8_t i = params - 5; i > 0; i--) {
|
tto->addPosition(p[4]);
|
||||||
tto->addPosition(p[i + 4]);
|
|
||||||
}
|
|
||||||
tto->addPosition(p[4]); // Allow setting a value for the home angle for throttles to draw it
|
|
||||||
} else if (params > 3 && params < 39 && p[1] == HASH_KEYWORD_DCC) {
|
} else if (params > 3 && params < 39 && p[1] == HASH_KEYWORD_DCC) {
|
||||||
DIAG(F("Create DCC turntable %d at base address %d with %d positions"), p[0], p[2], params - 2);
|
DIAG(F("Create DCC turntable %d at base address %d with %d positions"), p[0], p[2], params - 2);
|
||||||
} else {
|
} else {
|
||||||
|
@ -1119,6 +1133,9 @@ bool DCCEXParser::parseI(Print *stream, int16_t params, int16_t p[])
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
return true;
|
return true;
|
||||||
|
|
||||||
|
default: // Anything else is invalid
|
||||||
|
return false;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
|
|
@ -38,7 +38,7 @@ struct DCCEXParser
|
||||||
static void setFilter(FILTER_CALLBACK filter);
|
static void setFilter(FILTER_CALLBACK filter);
|
||||||
static void setRMFTFilter(FILTER_CALLBACK filter);
|
static void setRMFTFilter(FILTER_CALLBACK filter);
|
||||||
static void setAtCommandCallback(AT_COMMAND_CALLBACK filter);
|
static void setAtCommandCallback(AT_COMMAND_CALLBACK filter);
|
||||||
static const int MAX_COMMAND_PARAMS=MAX_PARSER_PARAMS; // Must not exceed this
|
static const int MAX_COMMAND_PARAMS=10; // Must not exceed this
|
||||||
|
|
||||||
private:
|
private:
|
||||||
|
|
||||||
|
|
|
@ -70,18 +70,16 @@ void Turntable::addPosition(uint16_t value) {
|
||||||
}
|
}
|
||||||
|
|
||||||
// Get value for position
|
// Get value for position
|
||||||
uint16_t Turntable::getPositionValue(size_t position) {
|
uint16_t Turntable::getPositionValue(uint8_t position) {
|
||||||
TurntablePosition* currentPosition = _turntablePositions.getHead();
|
TurntablePosition* currentPosition = _turntablePositions.getHead();
|
||||||
for (size_t i = 0; i < position && currentPosition; i++) {
|
while (currentPosition) {
|
||||||
|
if (currentPosition->index == position) {
|
||||||
|
return currentPosition->data;
|
||||||
|
}
|
||||||
currentPosition = currentPosition->next;
|
currentPosition = currentPosition->next;
|
||||||
}
|
}
|
||||||
|
|
||||||
if (currentPosition) {
|
|
||||||
return currentPosition->data;
|
|
||||||
} else {
|
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
}
|
|
||||||
|
|
||||||
// Get the count of positions associated with the turntable
|
// Get the count of positions associated with the turntable
|
||||||
uint8_t Turntable::getPositionCount() {
|
uint8_t Turntable::getPositionCount() {
|
||||||
|
|
18
Turntables.h
18
Turntables.h
|
@ -32,8 +32,8 @@
|
||||||
// EXTT = EX-Turntable
|
// EXTT = EX-Turntable
|
||||||
// DCC = DCC accessory turntables - to be added later
|
// DCC = DCC accessory turntables - to be added later
|
||||||
enum {
|
enum {
|
||||||
TURNTABLE_EXTT = 1,
|
TURNTABLE_EXTT = 0,
|
||||||
// TURNTABLE_DCC = 2,
|
TURNTABLE_DCC = 1,
|
||||||
};
|
};
|
||||||
|
|
||||||
/*************************************************************************************
|
/*************************************************************************************
|
||||||
|
@ -41,18 +41,19 @@ enum {
|
||||||
*
|
*
|
||||||
*************************************************************************************/
|
*************************************************************************************/
|
||||||
struct TurntablePosition {
|
struct TurntablePosition {
|
||||||
|
uint8_t index;
|
||||||
uint16_t data;
|
uint16_t data;
|
||||||
TurntablePosition* next;
|
TurntablePosition* next;
|
||||||
|
|
||||||
TurntablePosition(uint16_t value) : data(value), next(nullptr) {}
|
TurntablePosition(uint8_t idx, uint16_t value) : index(idx), data(value), next(nullptr) {}
|
||||||
};
|
};
|
||||||
|
|
||||||
class TurntablePositionList {
|
class TurntablePositionList {
|
||||||
public:
|
public:
|
||||||
TurntablePositionList() : head(nullptr) {}
|
TurntablePositionList() : head(nullptr), currentIndex(0) {}
|
||||||
|
|
||||||
void insert(uint16_t value) {
|
void insert(uint16_t value) {
|
||||||
TurntablePosition* newPosition = new TurntablePosition(value);
|
TurntablePosition* newPosition = new TurntablePosition(currentIndex++, value);
|
||||||
if(!head) {
|
if(!head) {
|
||||||
head = newPosition;
|
head = newPosition;
|
||||||
} else {
|
} else {
|
||||||
|
@ -67,6 +68,7 @@ public:
|
||||||
|
|
||||||
private:
|
private:
|
||||||
TurntablePosition* head;
|
TurntablePosition* head;
|
||||||
|
uint8_t currentIndex;
|
||||||
|
|
||||||
};
|
};
|
||||||
|
|
||||||
|
@ -87,8 +89,8 @@ protected:
|
||||||
union {
|
union {
|
||||||
struct {
|
struct {
|
||||||
bool hidden : 1;
|
bool hidden : 1;
|
||||||
uint8_t turntableType : 2;
|
bool turntableType : 1;
|
||||||
uint8_t position : 5; // Allows up to 38 positions including 0/home
|
uint8_t position : 6; // Allows up to 63 positions including 0/home
|
||||||
};
|
};
|
||||||
uint8_t flags;
|
uint8_t flags;
|
||||||
};
|
};
|
||||||
|
@ -148,7 +150,7 @@ public:
|
||||||
inline Turntable *next() { return _nextTurntable; }
|
inline Turntable *next() { return _nextTurntable; }
|
||||||
void printState(Print *stream);
|
void printState(Print *stream);
|
||||||
void addPosition(uint16_t value);
|
void addPosition(uint16_t value);
|
||||||
uint16_t getPositionValue(size_t position);
|
uint16_t getPositionValue(uint8_t position);
|
||||||
uint8_t getPositionCount();
|
uint8_t getPositionCount();
|
||||||
|
|
||||||
/*
|
/*
|
||||||
|
|
11
defines.h
11
defines.h
|
@ -222,17 +222,6 @@
|
||||||
#define IO_NO_HAL
|
#define IO_NO_HAL
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
////////////////////////////////////////////////////////////////////////////////
|
|
||||||
//
|
|
||||||
// This defines the maximum number of parameters DCCEXParser will accept.
|
|
||||||
// The increase is required to allow for a sufficient number of turntable positions.
|
|
||||||
//
|
|
||||||
#ifdef IO_NO_HAL
|
|
||||||
#define MAX_PARSER_PARAMS 10
|
|
||||||
#else
|
|
||||||
#define MAX_PARSER_PARAMS 20
|
|
||||||
#endif
|
|
||||||
|
|
||||||
#if __has_include ( "myAutomation.h")
|
#if __has_include ( "myAutomation.h")
|
||||||
#if defined(HAS_ENOUGH_MEMORY) || defined(DISABLE_EEPROM) || defined(DISABLE_PROG)
|
#if defined(HAS_ENOUGH_MEMORY) || defined(DISABLE_EEPROM) || defined(DISABLE_PROG)
|
||||||
#define EXRAIL_ACTIVE
|
#define EXRAIL_ACTIVE
|
||||||
|
|
Loading…
Reference in New Issue
Block a user