1
0
mirror of https://github.com/DCC-EX/CommandStation-EX.git synced 2024-12-23 12:51:24 +01:00

in principle schedules packets

This commit is contained in:
Harald Barth 2022-07-30 21:11:51 +02:00
parent 37f44709f9
commit 67e8c04314
5 changed files with 51 additions and 22 deletions

View File

@ -71,7 +71,13 @@ void DCC::begin() {
// Add main and prog drivers to the main and prog packet sources (dcc-tracks).
std::vector<MotorDriver*> v;
v = MotorDriverContainer::mDC.getDriverType(RMT_MAIN|TIMER_MAIN);
v = MotorDriverContainer::mDC.getDriverType(RMT_MAIN);
v.front()->setChannel(new RMTChannel(v.front()->getSignalPin(), true));
for (const auto& d: v) DCCTrack::mainTrack.addDriver(d);
v = MotorDriverContainer::mDC.getDriverType(RMT_PROG|TIMER_PROG);
for (const auto& d: v) DCCTrack::progTrack.addDriver(d);

View File

@ -62,8 +62,17 @@ void IRAM_ATTR interrupt(rmt_channel_t channel, void *t) {
tt->RMTinterrupt();
}
RMTChannel::RMTChannel(byte pin, byte ch, byte plen, bool isMain) {
RMTChannel::RMTChannel(byte pin, bool isMain) {
byte ch;
byte plen;
if (isMain) {
ch = 0;
plen = PREAMBLE_BITS_MAIN;
} else {
ch = 2;
plen = PREAMBLE_BITS_PROG;
}
// preamble
preambleLen = plen+2; // plen 1 bits, one 0 bit and one EOF marker
preamble = (rmt_item32_t*)malloc(preambleLen*sizeof(rmt_item32_t));
@ -146,17 +155,19 @@ void RMTChannel::RMTprefill() {
const byte transmitMask[] = {0x80, 0x40, 0x20, 0x10, 0x08, 0x04, 0x02, 0x01};
//bool RMTChannel::RMTfillData(const byte buffer[], byte byteCount, byte repeatCount=0) {
bool RMTChannel::RMTfillData(dccPacket packet) {
int RMTChannel::RMTfillData(dccPacket packet) {
// dataReady: Signals to then interrupt routine. It is set when
// we have data in the channel buffer which can be copied out
// to the HW. dataRepeat on the other hand signals back to
// the caller of this function if the data has been sent enough
// times (0 to 3 means 1 to 4 times in total).
if (dataReady == true || dataRepeat > 0) // we have still old work to do
return false;
if (dataReady == true)
return 1000;
if (dataRepeat > 0) // we have still old work to do
return dataRepeat;
if (DATA_LEN(packet.length) > maxDataLen) { // this would overun our allocated memory for data
DIAG(F("Can not convert DCC bytes # %d to DCC bits %d, buffer too small"), packet.length, maxDataLen);
return false; // something very broken, can not convert packet
return -1; // something very broken, can not convert packet
}
byte *buffer = packet.data;
@ -177,7 +188,7 @@ bool RMTChannel::RMTfillData(dccPacket packet) {
dataLen = bitcounter;
dataReady = true;
dataRepeat = packet.repeat+1; // repeatCount of 0 means send once
return true;
return 0;
}
void IRAM_ATTR RMTChannel::RMTinterrupt() {

View File

@ -32,16 +32,10 @@
class RMTChannel {
public:
inline RMTChannel(byte pin, bool isMain) {
if (isMain)
RMTChannel(pin, 0, PREAMBLE_BITS_MAIN, 1);
else
RMTChannel(pin, 2, PREAMBLE_BITS_PROG, 0);
};
RMTChannel(byte pin, byte ch, byte plen, bool isProg);
RMTChannel(byte pin, bool isMain);
void IRAM_ATTR RMTinterrupt();
void RMTprefill();
bool RMTfillData(dccPacket packet);
int RMTfillData(dccPacket packet);
//bool RMTfillData(const byte buffer[], byte byteCount, byte repeatCount);
static RMTChannel mainRMTChannel;

View File

@ -38,11 +38,14 @@ MotorDriver::MotorDriver(byte power_pin, byte signal_pin, byte signal_pin2, int8
getFastPin(F("POWER"),powerPin,fastPowerPin);
pinMode(powerPin, OUTPUT);
if (dtype == RMT_MAIN) {
if (dtype & (RMT_MAIN | RMT_PROG)) {
signalPin=signal_pin;
/*
#if defined(ARDUINO_ARCH_ESP32)
rmtChannel = new RMTChannel(signalPin, true); // true: isMain
//rmtChannel = new RMTChannel(signalPin, 0, PREAMBLE_BITS_MAIN, true); // true: isMain
rmtChannel = new RMTChannel(signalPin, dtype == RMT_MAIN); // true: isMain
#endif
*/
dualSignal=false;
} else if (dtype & (TIMER_MAIN | TIMER_PROG)) {
signalPin=signal_pin;
@ -209,7 +212,10 @@ void MotorDriver::getFastPin(const FSH* type,int pin, bool input, FASTPIN & res
}
bool MotorDriver::schedulePacket(dccPacket packet) {
if(!rmtChannel) return true; // fake success if functionality is not there
if(!rmtChannel) {
DIAG(F("no rmt Channel"));
return true; // fake success if functionality is not there
}
outQueue.push(packet);
uint16_t size = outQueue.size();
@ -220,8 +226,16 @@ bool MotorDriver::schedulePacket(dccPacket packet) {
}
void MotorDriver::loop() {
if (rmtChannel && !outQueue.empty() && rmtChannel->RMTfillData(outQueue.front()))
outQueue.pop();
int r;
if (rmtChannel && !outQueue.empty()) {
r = rmtChannel->RMTfillData(outQueue.front());
if (r == 0) {
DIAG(F("r=OK"));
outQueue.pop();
}
else
DIAG(F("r=%d"), r);
}
}
MotorDriverContainer::MotorDriverContainer(const FSH * motorShieldName,

View File

@ -83,12 +83,16 @@ class MotorDriver {
static bool commonFaultPin; // This is a stupid motor shield which has only a common fault pin for both outputs
inline byte getFaultPin() {
return faultPin;
}
};
inline byte getSignalPin() {
return signalPin;
};
#if defined(ARDUINO_ARCH_ESP32)
void loop();
inline driverType type() { return dtype; };
inline void setType(driverType t) { dtype = t; };
bool schedulePacket(dccPacket packet);
inline void setChannel(RMTChannel * r) { rmtChannel = r; };
#endif
private: