DccDebugFlow.hxx

Go to the documentation of this file.

 
#ifndef _OPENLCB_DCCDEBUGFLOW_HXX_
#define _OPENLCB_DCCDEBUGFLOW_HXX_
 
namespace openlcb {
 
class DccPacketDebugFlow : public StateFlow<Buffer<dcc::Packet>, QList<1>> {
 public:
  DccPacketDebugFlow(openlcb::Node* node)
      : StateFlow<Buffer<dcc::Packet>, QList<1>>(
            node->iface()->dispatcher()->service()),
        node_(node) {}
 
 private:
  Action entry() override {
    Debug::DccPacketDelay::set(false);
    return allocate_and_call(node_->iface()->global_message_write_flow(),
                             STATE(msg_allocated));
  }
 
  Action msg_allocated() {
    auto* b =
        get_allocation_result(node_->iface()->global_message_write_flow());
 
    b->data()->reset(
        static_cast<openlcb::Defs::MTI>(openlcb::Defs::MTI_XPRESSNET + 1),
        node_->node_id(),
        string((char*)message()->data()->payload, message()->data()->dlc));
    node_->iface()->global_message_write_flow()->send(b);
    return release_and_exit();
  }
 
  openlcb::Node* node_;
};
 
extern DccPacketDebugFlow g_packet_debug_flow;
 
class DccDebugDecodeFlow : public dcc::DccDecodeFlow {
 public:
  DccDebugDecodeFlow(Service* service, const char* path) : dcc::DccDecodeFlow(service, path) {}
 
 private:
  void dcc_packet_finished(const uint8_t* payload, size_t len) override {
    auto* b = g_packet_debug_flow.alloc();
    b->data()->dlc = len;
    memcpy(b->data()->payload, payload, len);
    g_packet_debug_flow.send(b);
  }
 
  void mm_packet_finished(const uint8_t* payload, size_t len) override {
    auto* b = g_packet_debug_flow.alloc();
    b->data()->dlc = len;
    memcpy(b->data()->payload, payload, len);
    b->data()->payload[0] |= 0xFC;
    g_packet_debug_flow.send(b);
  }
 
  void debug_data(uint32_t value) override {
    value /= (configCPU_CLOCK_HZ / 1000000);
    log(decoder_.state());
    log(value);
  }
 
  void log(uint8_t value) {
    dbuffer[ptr] = value;
    ++ptr;
    if (ptr >= sizeof(dbuffer)) ptr = 0;
  }
  uint8_t dbuffer[1024];
  uint16_t ptr = 0;
};
 
 
} // namespace
 
#endif // _OPENLCB_DCCDEBUGFLOW_HXX_