1. 新建打印程序。
parent
bfed071e22
commit
52885a4316
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
@ -0,0 +1,65 @@
|
|||||||
|
#ifndef _MSGHANDLER_HPP_
|
||||||
|
#define _MSGHANDLER_HPP_
|
||||||
|
|
||||||
|
#include <queue>
|
||||||
|
#include <mutex>
|
||||||
|
#include <vector>
|
||||||
|
#include <map>
|
||||||
|
|
||||||
|
class MsgHandler {
|
||||||
|
public:
|
||||||
|
int fd;
|
||||||
|
std::string device;
|
||||||
|
std::vector<uint8_t> m_PrintData;
|
||||||
|
|
||||||
|
MsgHandler();
|
||||||
|
~MsgHandler() = default;
|
||||||
|
|
||||||
|
void HandleDdsMsg(const std::map<std::string, std::string>& msg);
|
||||||
|
void EncodeMsg(const std::map<std::string, std::string>& msg);
|
||||||
|
bool SetDevice(const std::string& device);
|
||||||
|
|
||||||
|
virtual bool OpenPort(const std::string& port, const std::string& baudrate);
|
||||||
|
virtual int SendDeviceMsg(const std::vector<uint8_t>& data);
|
||||||
|
virtual int RecvDeviceMsg(std::vector<uint8_t>& data, int timeoutMs);
|
||||||
|
int SendMsg(const std::vector<uint8_t>& data);
|
||||||
|
int RecvMsg(std::vector<uint8_t>& data, int timeoutMs);
|
||||||
|
bool isOpen() const {
|
||||||
|
return fd != -1;
|
||||||
|
}
|
||||||
|
void ClosePort();
|
||||||
|
|
||||||
|
private:
|
||||||
|
std::vector<char> BuildLine(int m_max, const std::map<int, std::string>& PointList, int no_line_min = 0, int no_line_max = 0); //行线条生成器
|
||||||
|
std::vector<char> BuildStringLine(std::map<int, std::string>& PointList); //行线条生成器
|
||||||
|
std::vector<char> BuildStringLine_HSK33(std::map<int, std::string>& PointList); //行线条生成器
|
||||||
|
|
||||||
|
void Page_ClearAndSet(std::vector<uint8_t>& Data, char * h1h2h3h4);
|
||||||
|
void Page_ESCL (std::vector<uint8_t>& Data, const char *n1n2, const char *x1x2x3x4, const char *y1y2y3y4,
|
||||||
|
const char *x5x6x7x8, const char *y5y6y7y8, char d, char w);
|
||||||
|
void Page_ESCPC(std::vector<uint8_t>& Data, const char *n1n2, const char *x1x2x3x4, const char *y1y2y3y4,
|
||||||
|
char w, char h, char c, const char * r1r2, const char * s1s2);
|
||||||
|
void Page_ESCRC(std::vector<uint8_t>& Data, const char *n1n2, const char *str);
|
||||||
|
void Page_ESCH(std::vector<uint8_t>& Data, char n, char *x1x2x3x4, char *y1y2y3y4, char *bmp, int bmpsize);
|
||||||
|
void Page_Cut(std::vector<uint8_t>& Data);
|
||||||
|
void Page_End(std::vector<uint8_t>& Data);
|
||||||
|
void GtstrLength(int iVal, char *p);
|
||||||
|
|
||||||
|
void Print1_1(const std::map<std::string, std::string>& msg);
|
||||||
|
|
||||||
|
void Print1_2(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print2_2(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print3_2(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print4_2(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print5_2(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print6_2(const std::map<std::string, std::string>& msg);
|
||||||
|
|
||||||
|
void Print1_3(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print2_3(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print4_3(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print5_3(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print6_3(const std::map<std::string, std::string>& msg);
|
||||||
|
void Print8_3(const std::map<std::string, std::string>& msg);
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
||||||
@ -0,0 +1,208 @@
|
|||||||
|
// Copyright 2016 Proyectos y Sistemas de Mantenimiento SL (eProsima).
|
||||||
|
//
|
||||||
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
// you may not use this file except in compliance with the License.
|
||||||
|
// You may obtain a copy of the License at
|
||||||
|
//
|
||||||
|
// http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
//
|
||||||
|
// Unless required by applicable law or agreed to in writing, software
|
||||||
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
// See the License for the specific language governing permissions and
|
||||||
|
// limitations under the License.
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* @file Publisher.cxx
|
||||||
|
* This file contains the implementation of the publisher functions.
|
||||||
|
*
|
||||||
|
* This file was generated by the tool fastddsgen.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "Publisher.hpp"
|
||||||
|
|
||||||
|
#include <condition_variable>
|
||||||
|
#include <csignal>
|
||||||
|
#include <stdexcept>
|
||||||
|
#include <thread>
|
||||||
|
|
||||||
|
#include <fastdds/dds/domain/DomainParticipantFactory.hpp>
|
||||||
|
#include <fastdds/dds/log/Log.hpp>
|
||||||
|
#include <fastdds/dds/publisher/DataWriter.hpp>
|
||||||
|
#include <fastdds/dds/publisher/Publisher.hpp>
|
||||||
|
#include <fastdds/dds/publisher/qos/DataWriterQos.hpp>
|
||||||
|
#include <fastdds/dds/publisher/qos/PublisherQos.hpp>
|
||||||
|
|
||||||
|
#include "SystemPubSubTypes.hpp"
|
||||||
|
|
||||||
|
#include "msg.hpp"
|
||||||
|
#include "MsgHandler.hpp"
|
||||||
|
|
||||||
|
using namespace eprosima::fastdds::dds;
|
||||||
|
|
||||||
|
PublisherApp::PublisherApp(
|
||||||
|
const int& domain_id)
|
||||||
|
: factory_(nullptr)
|
||||||
|
, participant_(nullptr)
|
||||||
|
, publisher_(nullptr)
|
||||||
|
, topic_(nullptr)
|
||||||
|
, writer_(nullptr)
|
||||||
|
, type_(new PrintRspPubSubType())
|
||||||
|
, matched_(0)
|
||||||
|
, samples_sent_(0)
|
||||||
|
, stop_(false)
|
||||||
|
{
|
||||||
|
//
|
||||||
|
|
||||||
|
// Create the participant
|
||||||
|
DomainParticipantQos pqos = PARTICIPANT_QOS_DEFAULT;
|
||||||
|
pqos.name("Print_pub_participant");
|
||||||
|
pqos.wire_protocol().builtin.discovery_config.leaseDuration = Duration_t(60, 0);
|
||||||
|
pqos.wire_protocol().builtin.discovery_config.leaseDuration_announcementperiod = Duration_t(30, 0);
|
||||||
|
factory_ = DomainParticipantFactory::get_shared_instance();
|
||||||
|
participant_ = factory_->create_participant(domain_id, pqos, nullptr, StatusMask::none());
|
||||||
|
if (participant_ == nullptr)
|
||||||
|
{
|
||||||
|
throw std::runtime_error("PrintRsp Participant initialization failed");
|
||||||
|
}
|
||||||
|
|
||||||
|
// Register the type
|
||||||
|
type_.register_type(participant_);
|
||||||
|
|
||||||
|
// Create the publisher
|
||||||
|
PublisherQos pub_qos = PUBLISHER_QOS_DEFAULT;
|
||||||
|
participant_->get_default_publisher_qos(pub_qos);
|
||||||
|
publisher_ = participant_->create_publisher(pub_qos, nullptr, StatusMask::none());
|
||||||
|
if (publisher_ == nullptr)
|
||||||
|
{
|
||||||
|
throw std::runtime_error("PrintRsp Publisher initialization failed");
|
||||||
|
}
|
||||||
|
|
||||||
|
// Create the topic
|
||||||
|
TopicQos topic_qos = TOPIC_QOS_DEFAULT;
|
||||||
|
participant_->get_default_topic_qos(topic_qos);
|
||||||
|
topic_ = participant_->create_topic("PrintRspTopic", type_.get_type_name(), topic_qos);
|
||||||
|
if (topic_ == nullptr)
|
||||||
|
{
|
||||||
|
throw std::runtime_error("PrintRsp Topic initialization failed");
|
||||||
|
}
|
||||||
|
|
||||||
|
// Create the data writer
|
||||||
|
DataWriterQos writer_qos = DATAWRITER_QOS_DEFAULT;
|
||||||
|
publisher_->get_default_datawriter_qos(writer_qos);
|
||||||
|
writer_qos.reliability().kind = ReliabilityQosPolicyKind::RELIABLE_RELIABILITY_QOS;
|
||||||
|
writer_qos.durability().kind = DurabilityQosPolicyKind::TRANSIENT_LOCAL_DURABILITY_QOS;
|
||||||
|
writer_qos.history().kind = HistoryQosPolicyKind::KEEP_LAST_HISTORY_QOS;
|
||||||
|
writer_ = publisher_->create_datawriter(topic_, writer_qos, this, StatusMask::all());
|
||||||
|
if (writer_ == nullptr)
|
||||||
|
{
|
||||||
|
throw std::runtime_error("PrintRsp DataWriter initialization failed");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
PublisherApp::~PublisherApp()
|
||||||
|
{
|
||||||
|
if (nullptr != participant_)
|
||||||
|
{
|
||||||
|
// Delete DDS entities contained within the DomainParticipant
|
||||||
|
participant_->delete_contained_entities();
|
||||||
|
|
||||||
|
// Delete DomainParticipant
|
||||||
|
factory_->delete_participant(participant_);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void PublisherApp::on_publication_matched(
|
||||||
|
DataWriter* writer,
|
||||||
|
const PublicationMatchedStatus& info)
|
||||||
|
{
|
||||||
|
if (info.current_count_change == 1)
|
||||||
|
{
|
||||||
|
{
|
||||||
|
std::lock_guard<std::mutex> lock(mutex_);
|
||||||
|
matched_ = info.current_count;
|
||||||
|
}
|
||||||
|
std::cout << writer->get_topic()->get_name() << " Publisher matched." << std::endl;
|
||||||
|
cv_.notify_one();
|
||||||
|
}
|
||||||
|
else if (info.current_count_change == -1)
|
||||||
|
{
|
||||||
|
{
|
||||||
|
std::lock_guard<std::mutex> lock(mutex_);
|
||||||
|
matched_ = info.current_count;
|
||||||
|
}
|
||||||
|
std::cout << writer->get_topic()->get_name() << " Publisher unmatched." << std::endl;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
std::cout << info.current_count_change
|
||||||
|
<< " is not a valid value for PublicationMatchedStatus current count change" << std::endl;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void PublisherApp::run(std::shared_ptr<MsgHandler> handler)
|
||||||
|
{
|
||||||
|
while (!is_stopped())
|
||||||
|
{
|
||||||
|
std::unique_lock<std::mutex> lock(MsgData::queue_cv_mtx_, std::try_to_lock);
|
||||||
|
if (lock.owns_lock())
|
||||||
|
{
|
||||||
|
if(!MsgData::PrintReq_queue_.empty())
|
||||||
|
{
|
||||||
|
PrintReq req = std::move(MsgData::PrintReq_queue_.front());
|
||||||
|
MsgData::PrintReq_queue_.pop();
|
||||||
|
lock.unlock();
|
||||||
|
|
||||||
|
std::cout << "index: " << req.index() << std::endl;
|
||||||
|
handler->HandleDdsMsg(req.msg());
|
||||||
|
|
||||||
|
PrintRsp rsp;
|
||||||
|
rsp.index() = req.index();
|
||||||
|
rsp.msg() = "success";
|
||||||
|
writer_->write(&rsp);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
lock.unlock();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
// Wait for period or stop event
|
||||||
|
std::unique_lock<std::mutex> period_lock(mutex_);
|
||||||
|
cv_.wait_for(period_lock, std::chrono::milliseconds(period_ms_), [this]()
|
||||||
|
{
|
||||||
|
return is_stopped();
|
||||||
|
});
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
bool PublisherApp::publish()
|
||||||
|
{
|
||||||
|
bool ret = false;
|
||||||
|
// Wait for the data endpoints discovery
|
||||||
|
std::unique_lock<std::mutex> matched_lock(mutex_);
|
||||||
|
cv_.wait(matched_lock, [&]()
|
||||||
|
{
|
||||||
|
// at least one has been discovered
|
||||||
|
return ((matched_ > 0) || is_stopped());
|
||||||
|
});
|
||||||
|
|
||||||
|
if (!is_stopped())
|
||||||
|
{
|
||||||
|
/* Initialize your structure here */
|
||||||
|
WeighRsp sample_;
|
||||||
|
ret = (RETCODE_OK == writer_->write(&sample_));
|
||||||
|
}
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
bool PublisherApp::is_stopped()
|
||||||
|
{
|
||||||
|
return stop_.load();
|
||||||
|
}
|
||||||
|
|
||||||
|
void PublisherApp::stop()
|
||||||
|
{
|
||||||
|
stop_.store(true);
|
||||||
|
cv_.notify_one();
|
||||||
|
}
|
||||||
@ -0,0 +1,76 @@
|
|||||||
|
// Copyright 2016 Proyectos y Sistemas de Mantenimiento SL (eProsima).
|
||||||
|
//
|
||||||
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
// you may not use this file except in compliance with the License.
|
||||||
|
// You may obtain a copy of the License at
|
||||||
|
//
|
||||||
|
// http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
//
|
||||||
|
// Unless required by applicable law or agreed to in writing, software
|
||||||
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
// See the License for the specific language governing permissions and
|
||||||
|
// limitations under the License.
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* @file PublisherApp.hpp
|
||||||
|
* This header file contains the declaration of the publisher functions.
|
||||||
|
*
|
||||||
|
* This file was generated by the tool fastddsgen.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef FAST_DDS_GENERATED__PUBLISHERAPP_HPP
|
||||||
|
#define FAST_DDS_GENERATED__PUBLISHERAPP_HPP
|
||||||
|
|
||||||
|
#include <condition_variable>
|
||||||
|
|
||||||
|
#include <fastdds/dds/domain/DomainParticipant.hpp>
|
||||||
|
#include <fastdds/dds/domain/DomainParticipantFactory.hpp>
|
||||||
|
#include <fastdds/dds/publisher/DataWriterListener.hpp>
|
||||||
|
#include <fastdds/dds/topic/TypeSupport.hpp>
|
||||||
|
|
||||||
|
#include "MsgHandler.hpp"
|
||||||
|
|
||||||
|
class PublisherApp : public eprosima::fastdds::dds::DataWriterListener
|
||||||
|
{
|
||||||
|
public:
|
||||||
|
|
||||||
|
PublisherApp(
|
||||||
|
const int& domain_id);
|
||||||
|
|
||||||
|
~PublisherApp();
|
||||||
|
|
||||||
|
//! Publisher matched method
|
||||||
|
void on_publication_matched(
|
||||||
|
eprosima::fastdds::dds::DataWriter* writer,
|
||||||
|
const eprosima::fastdds::dds::PublicationMatchedStatus& info) override;
|
||||||
|
|
||||||
|
//! Run publisher
|
||||||
|
void run(std::shared_ptr<MsgHandler> handler);
|
||||||
|
|
||||||
|
//! Trigger the end of execution
|
||||||
|
void stop();
|
||||||
|
|
||||||
|
private:
|
||||||
|
|
||||||
|
//! Return the current state of execution
|
||||||
|
bool is_stopped();
|
||||||
|
|
||||||
|
//! Publish a sample
|
||||||
|
bool publish();
|
||||||
|
|
||||||
|
std::shared_ptr<eprosima::fastdds::dds::DomainParticipantFactory> factory_;
|
||||||
|
eprosima::fastdds::dds::DomainParticipant* participant_;
|
||||||
|
eprosima::fastdds::dds::Publisher* publisher_;
|
||||||
|
eprosima::fastdds::dds::Topic* topic_;
|
||||||
|
eprosima::fastdds::dds::DataWriter* writer_;
|
||||||
|
eprosima::fastdds::dds::TypeSupport type_;
|
||||||
|
std::condition_variable cv_;
|
||||||
|
int32_t matched_;
|
||||||
|
std::mutex mutex_;
|
||||||
|
const uint32_t period_ms_ = 100; // in ms
|
||||||
|
uint16_t samples_sent_;
|
||||||
|
std::atomic<bool> stop_;
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif // FAST_DDS_GENERATED__PUBLISHERAPP_HPP
|
||||||
@ -0,0 +1,171 @@
|
|||||||
|
// Copyright 2016 Proyectos y Sistemas de Mantenimiento SL (eProsima).
|
||||||
|
//
|
||||||
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
// you may not use this file except in compliance with the License.
|
||||||
|
// You may obtain a copy of the License at
|
||||||
|
//
|
||||||
|
// http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
//
|
||||||
|
// Unless required by applicable law or agreed to in writing, software
|
||||||
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
// See the License for the specific language governing permissions and
|
||||||
|
// limitations under the License.
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* @file Subscriber.cxx
|
||||||
|
* This file contains the implementation of the subscriber functions.
|
||||||
|
*
|
||||||
|
* This file was generated by the tool fastddsgen.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "Subscriber.hpp"
|
||||||
|
|
||||||
|
#include <condition_variable>
|
||||||
|
#include <stdexcept>
|
||||||
|
|
||||||
|
#include <fastdds/dds/core/status/SubscriptionMatchedStatus.hpp>
|
||||||
|
#include <fastdds/dds/domain/DomainParticipantFactory.hpp>
|
||||||
|
#include <fastdds/dds/subscriber/DataReader.hpp>
|
||||||
|
#include <fastdds/dds/subscriber/qos/DataReaderQos.hpp>
|
||||||
|
#include <fastdds/dds/subscriber/qos/SubscriberQos.hpp>
|
||||||
|
#include <fastdds/dds/subscriber/SampleInfo.hpp>
|
||||||
|
#include <fastdds/dds/subscriber/Subscriber.hpp>
|
||||||
|
|
||||||
|
#include "SystemPubSubTypes.hpp"
|
||||||
|
|
||||||
|
#include "msg.hpp"
|
||||||
|
|
||||||
|
using namespace eprosima::fastdds::dds;
|
||||||
|
|
||||||
|
SubscriberApp::SubscriberApp(
|
||||||
|
const int& domain_id)
|
||||||
|
: factory_(nullptr)
|
||||||
|
, participant_(nullptr)
|
||||||
|
, subscriber_(nullptr)
|
||||||
|
, topic_(nullptr)
|
||||||
|
, reader_(nullptr)
|
||||||
|
, type_(new PrintReqPubSubType())
|
||||||
|
, samples_received_(0)
|
||||||
|
, stop_(false)
|
||||||
|
{
|
||||||
|
// Create the participant
|
||||||
|
DomainParticipantQos pqos = PARTICIPANT_QOS_DEFAULT;
|
||||||
|
pqos.name("Print_sub_participant");
|
||||||
|
pqos.wire_protocol().builtin.discovery_config.leaseDuration = Duration_t(60, 0);
|
||||||
|
pqos.wire_protocol().builtin.discovery_config.leaseDuration_announcementperiod = Duration_t(30, 0);
|
||||||
|
factory_ = DomainParticipantFactory::get_shared_instance();
|
||||||
|
participant_ = factory_->create_participant(domain_id, pqos, nullptr, StatusMask::none());
|
||||||
|
if (participant_ == nullptr)
|
||||||
|
{
|
||||||
|
throw std::runtime_error("PrintReq Participant initialization failed");
|
||||||
|
}
|
||||||
|
|
||||||
|
// Register the type
|
||||||
|
type_.register_type(participant_);
|
||||||
|
|
||||||
|
// Create the subscriber
|
||||||
|
SubscriberQos sub_qos = SUBSCRIBER_QOS_DEFAULT;
|
||||||
|
participant_->get_default_subscriber_qos(sub_qos);
|
||||||
|
subscriber_ = participant_->create_subscriber(sub_qos, nullptr, StatusMask::none());
|
||||||
|
if (subscriber_ == nullptr)
|
||||||
|
{
|
||||||
|
throw std::runtime_error("PrintReq Subscriber initialization failed");
|
||||||
|
}
|
||||||
|
|
||||||
|
// Create the topic
|
||||||
|
TopicQos topic_qos = TOPIC_QOS_DEFAULT;
|
||||||
|
participant_->get_default_topic_qos(topic_qos);
|
||||||
|
topic_ = participant_->create_topic("PrintReqTopic", type_.get_type_name(), topic_qos);
|
||||||
|
if (topic_ == nullptr)
|
||||||
|
{
|
||||||
|
throw std::runtime_error("PrintReq Topic initialization failed");
|
||||||
|
}
|
||||||
|
|
||||||
|
// Create the reader
|
||||||
|
DataReaderQos reader_qos = DATAREADER_QOS_DEFAULT;
|
||||||
|
subscriber_->get_default_datareader_qos(reader_qos);
|
||||||
|
reader_qos.reliability().kind = ReliabilityQosPolicyKind::RELIABLE_RELIABILITY_QOS;
|
||||||
|
reader_qos.durability().kind = DurabilityQosPolicyKind::TRANSIENT_LOCAL_DURABILITY_QOS;
|
||||||
|
reader_qos.history().kind = HistoryQosPolicyKind::KEEP_LAST_HISTORY_QOS;
|
||||||
|
reader_ = subscriber_->create_datareader(topic_, reader_qos, this, StatusMask::all());
|
||||||
|
if (reader_ == nullptr)
|
||||||
|
{
|
||||||
|
throw std::runtime_error("PrintReq DataReader initialization failed");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
SubscriberApp::~SubscriberApp()
|
||||||
|
{
|
||||||
|
if (nullptr != participant_)
|
||||||
|
{
|
||||||
|
// Delete DDS entities contained within the DomainParticipant
|
||||||
|
participant_->delete_contained_entities();
|
||||||
|
|
||||||
|
// Delete DomainParticipant
|
||||||
|
factory_->delete_participant(participant_);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void SubscriberApp::on_subscription_matched(
|
||||||
|
DataReader* reader,
|
||||||
|
const SubscriptionMatchedStatus& info)
|
||||||
|
{
|
||||||
|
if (info.current_count_change == 1)
|
||||||
|
{
|
||||||
|
std::cout << reader->get_topicdescription()->get_name() << " Subscriber matched." << std::endl;
|
||||||
|
}
|
||||||
|
else if (info.current_count_change == -1)
|
||||||
|
{
|
||||||
|
std::cout << reader->get_topicdescription()->get_name() << " Subscriber unmatched." << std::endl;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
std::cout << info.current_count_change
|
||||||
|
<< " is not a valid value for SubscriptionMatchedStatus current count change" << std::endl;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void SubscriberApp::on_data_available(
|
||||||
|
DataReader* reader)
|
||||||
|
{
|
||||||
|
SampleInfo info;
|
||||||
|
std::string topic_name = reader->get_topicdescription()->get_name();
|
||||||
|
std::cout << topic_name << std::endl;
|
||||||
|
|
||||||
|
if (topic_name == "PrintReqTopic")
|
||||||
|
{
|
||||||
|
PrintReq sample_;
|
||||||
|
while ((!is_stopped()) && (RETCODE_OK == reader->take_next_sample(&sample_, &info)))
|
||||||
|
{
|
||||||
|
if ((info.instance_state == ALIVE_INSTANCE_STATE) && info.valid_data)
|
||||||
|
{
|
||||||
|
{
|
||||||
|
std::unique_lock<std::mutex> lock(MsgData::queue_cv_mtx_);
|
||||||
|
MsgData::PrintReq_queue_.push(std::move(sample_));
|
||||||
|
lock.unlock();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void SubscriberApp::run()
|
||||||
|
{
|
||||||
|
std::unique_lock<std::mutex> lck(terminate_cv_mtx_);
|
||||||
|
terminate_cv_.wait(lck, [this]
|
||||||
|
{
|
||||||
|
return is_stopped();
|
||||||
|
});
|
||||||
|
}
|
||||||
|
|
||||||
|
bool SubscriberApp::is_stopped()
|
||||||
|
{
|
||||||
|
return stop_.load();
|
||||||
|
}
|
||||||
|
|
||||||
|
void SubscriberApp::stop()
|
||||||
|
{
|
||||||
|
stop_.store(true);
|
||||||
|
terminate_cv_.notify_all();
|
||||||
|
}
|
||||||
@ -0,0 +1,75 @@
|
|||||||
|
// Copyright 2016 Proyectos y Sistemas de Mantenimiento SL (eProsima).
|
||||||
|
//
|
||||||
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
// you may not use this file except in compliance with the License.
|
||||||
|
// You may obtain a copy of the License at
|
||||||
|
//
|
||||||
|
// http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
//
|
||||||
|
// Unless required by applicable law or agreed to in writing, software
|
||||||
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
// See the License for the specific language governing permissions and
|
||||||
|
// limitations under the License.
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* @file SubscriberApp.hpp
|
||||||
|
* This header file contains the declaration of the subscriber functions.
|
||||||
|
*
|
||||||
|
* This file was generated by the tool fastddsgen.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef FAST_DDS_GENERATED__SUBSCRIBERAPP_HPP
|
||||||
|
#define FAST_DDS_GENERATED__SUBSCRIBERAPP_HPP
|
||||||
|
|
||||||
|
#include <condition_variable>
|
||||||
|
|
||||||
|
#include <fastdds/dds/domain/DomainParticipant.hpp>
|
||||||
|
#include <fastdds/dds/domain/DomainParticipantFactory.hpp>
|
||||||
|
#include <fastdds/dds/subscriber/DataReaderListener.hpp>
|
||||||
|
#include <fastdds/dds/topic/TypeSupport.hpp>
|
||||||
|
|
||||||
|
#include "System.hpp"
|
||||||
|
|
||||||
|
class SubscriberApp : public eprosima::fastdds::dds::DataReaderListener
|
||||||
|
{
|
||||||
|
public:
|
||||||
|
|
||||||
|
SubscriberApp(
|
||||||
|
const int& domain_id);
|
||||||
|
|
||||||
|
virtual ~SubscriberApp();
|
||||||
|
|
||||||
|
//! Subscription callback
|
||||||
|
void on_data_available(
|
||||||
|
eprosima::fastdds::dds::DataReader* reader) override;
|
||||||
|
|
||||||
|
//! Subscriber matched method
|
||||||
|
void on_subscription_matched(
|
||||||
|
eprosima::fastdds::dds::DataReader* reader,
|
||||||
|
const eprosima::fastdds::dds::SubscriptionMatchedStatus& info) override;
|
||||||
|
|
||||||
|
//! Run subscriber
|
||||||
|
void run();
|
||||||
|
|
||||||
|
//! Trigger the end of execution
|
||||||
|
void stop();
|
||||||
|
|
||||||
|
private:
|
||||||
|
|
||||||
|
//! Return the current state of execution
|
||||||
|
bool is_stopped();
|
||||||
|
|
||||||
|
std::shared_ptr<eprosima::fastdds::dds::DomainParticipantFactory> factory_;
|
||||||
|
eprosima::fastdds::dds::DomainParticipant* participant_;
|
||||||
|
eprosima::fastdds::dds::Subscriber* subscriber_;
|
||||||
|
eprosima::fastdds::dds::Topic* topic_;
|
||||||
|
eprosima::fastdds::dds::DataReader* reader_;
|
||||||
|
eprosima::fastdds::dds::TypeSupport type_;
|
||||||
|
uint16_t samples_received_;
|
||||||
|
std::atomic<bool> stop_;
|
||||||
|
mutable std::mutex terminate_cv_mtx_;
|
||||||
|
std::condition_variable terminate_cv_;
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif // FAST_DDS_GENERATED__SUBSCRIBERAPP_HPP
|
||||||
@ -0,0 +1,168 @@
|
|||||||
|
// Copyright 2016 Proyectos y Sistemas de Mantenimiento SL (eProsima).
|
||||||
|
//
|
||||||
|
// Licensed under the Apache License, Version 2.0 (the "License");
|
||||||
|
// you may not use this file except in compliance with the License.
|
||||||
|
// You may obtain a copy of the License at
|
||||||
|
//
|
||||||
|
// http://www.apache.org/licenses/LICENSE-2.0
|
||||||
|
//
|
||||||
|
// Unless required by applicable law or agreed to in writing, software
|
||||||
|
// distributed under the License is distributed on an "AS IS" BASIS,
|
||||||
|
// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
||||||
|
// See the License for the specific language governing permissions and
|
||||||
|
// limitations under the License.
|
||||||
|
|
||||||
|
/*!
|
||||||
|
* @file Systemmain.cxx
|
||||||
|
* This file acts as a main entry point to the application.
|
||||||
|
*
|
||||||
|
* This file was generated by the tool fastddsgen.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <csignal>
|
||||||
|
#include <cstring>
|
||||||
|
#include <functional>
|
||||||
|
#include <iostream>
|
||||||
|
#include <stdexcept>
|
||||||
|
#include <thread>
|
||||||
|
|
||||||
|
#include <fastdds/dds/log/Log.hpp>
|
||||||
|
|
||||||
|
#include "Subscriber.hpp"
|
||||||
|
#include "Publisher.hpp"
|
||||||
|
#include "SerialMsgHandler.hpp"
|
||||||
|
#include "msg.hpp"
|
||||||
|
|
||||||
|
#define VERSION "v1.0"
|
||||||
|
|
||||||
|
using eprosima::fastdds::dds::Log;
|
||||||
|
|
||||||
|
std::function<void(int)> stop_handler;
|
||||||
|
void signal_handler(
|
||||||
|
int signum)
|
||||||
|
{
|
||||||
|
stop_handler(signum);
|
||||||
|
}
|
||||||
|
|
||||||
|
std::string parse_signal(
|
||||||
|
const int& signum)
|
||||||
|
{
|
||||||
|
switch (signum)
|
||||||
|
{
|
||||||
|
case SIGINT:
|
||||||
|
return "SIGINT";
|
||||||
|
case SIGTERM:
|
||||||
|
return "SIGTERM";
|
||||||
|
#ifndef _WIN32
|
||||||
|
case SIGQUIT:
|
||||||
|
return "SIGQUIT";
|
||||||
|
case SIGHUP:
|
||||||
|
return "SIGHUP";
|
||||||
|
#endif // _WIN32
|
||||||
|
default:
|
||||||
|
return "UNKNOWN SIGNAL";
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
std::queue<PrintReq> MsgData::PrintReq_queue_;
|
||||||
|
std::mutex MsgData::queue_cv_mtx_;
|
||||||
|
|
||||||
|
int main(int argc, char** argv)
|
||||||
|
{
|
||||||
|
auto ret = EXIT_SUCCESS;
|
||||||
|
std::shared_ptr<SubscriberApp> sub;
|
||||||
|
std::shared_ptr<PublisherApp> pub;
|
||||||
|
std::shared_ptr<MsgHandler> dev;
|
||||||
|
|
||||||
|
int domain_id = 0;
|
||||||
|
const char* interface = "serial";
|
||||||
|
const char* port = "ttyS1";
|
||||||
|
const char* baudrate = "9600";
|
||||||
|
const char* device = "Toledo";
|
||||||
|
|
||||||
|
for (int i = 1; i < argc; i++)
|
||||||
|
{
|
||||||
|
if (strcmp(argv[i], "--domain") == 0 && i + 1 < argc)
|
||||||
|
{
|
||||||
|
domain_id = atoi(argv[++i]);
|
||||||
|
}
|
||||||
|
else if (strcmp(argv[i], "--interface") == 0 && i + 1 < argc)
|
||||||
|
{
|
||||||
|
interface = argv[++i];
|
||||||
|
}
|
||||||
|
else if (strcmp(argv[i], "--port") == 0 && i + 1 < argc)
|
||||||
|
{
|
||||||
|
port = argv[++i];
|
||||||
|
}
|
||||||
|
else if (strcmp(argv[i], "--baudrate") == 0 && i + 1 < argc)
|
||||||
|
{
|
||||||
|
baudrate = argv[++i];
|
||||||
|
}
|
||||||
|
else if (strcmp(argv[i], "--device") == 0 && i + 1 < argc)
|
||||||
|
{
|
||||||
|
device = argv[++i];
|
||||||
|
}
|
||||||
|
else if (strcmp(argv[i], "--version") == 0)
|
||||||
|
{
|
||||||
|
std::cout << "Vesrion: " << VERSION << "\n";
|
||||||
|
return EXIT_SUCCESS;
|
||||||
|
}
|
||||||
|
else if (strcmp(argv[i], "--help") == 0)
|
||||||
|
{
|
||||||
|
std::cout << "Usage: [options]\n"
|
||||||
|
<< "Options:\n"
|
||||||
|
<< " --domain Set domain ID\n"
|
||||||
|
<< " --interface Set interface (e.g., serial)\n"
|
||||||
|
<< " --baudrate Set baudrate (e.g., 9600)\n"
|
||||||
|
<< " --port Set port name (e.g., ttyS1)\n"
|
||||||
|
<< " --device Set device name (e.g., NP80A)\n"
|
||||||
|
<< " --version Show software Version\n"
|
||||||
|
<< " --help Show this help message\n";
|
||||||
|
return EXIT_SUCCESS;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
std::cerr << "Unknown option: " << argv[i] << "\n";
|
||||||
|
std::cout << "Usage: [options]\n"
|
||||||
|
<< "Options:\n"
|
||||||
|
<< " --domain Set domain ID\n"
|
||||||
|
<< " --interface Set interface (e.g., serial)\n"
|
||||||
|
<< " --baudrate Set baudrate (e.g., 9600)\n"
|
||||||
|
<< " --port Set port name (e.g., ttyS1)\n"
|
||||||
|
<< " --device Set device name (e.g., NP80A)\n"
|
||||||
|
<< " --version Show software Version\n"
|
||||||
|
<< " --help Show this help message\n";
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
sub = std::make_shared<SubscriberApp>(domain_id);
|
||||||
|
pub = std::make_shared<PublisherApp>(domain_id);
|
||||||
|
dev = std::make_shared<SerialMsgHandler>();
|
||||||
|
|
||||||
|
dev->OpenPort(port, baudrate);
|
||||||
|
dev->SetDevice(device);
|
||||||
|
|
||||||
|
std::thread pub_thread(&PublisherApp::run, pub, dev);
|
||||||
|
|
||||||
|
std::cout << "Program is running. Please press Ctrl+C to stop at any time." << std::endl;
|
||||||
|
|
||||||
|
stop_handler = [&](int signum)
|
||||||
|
{
|
||||||
|
std::cout << "\n" << parse_signal(signum) << " received, stopping " << argv[1]
|
||||||
|
<< " execution." << std::endl;
|
||||||
|
pub->stop();
|
||||||
|
};
|
||||||
|
|
||||||
|
signal(SIGINT, signal_handler);
|
||||||
|
signal(SIGTERM, signal_handler);
|
||||||
|
#ifndef _WIN32
|
||||||
|
signal(SIGQUIT, signal_handler);
|
||||||
|
signal(SIGHUP, signal_handler);
|
||||||
|
#endif // _WIN32
|
||||||
|
|
||||||
|
pub_thread.join();
|
||||||
|
|
||||||
|
Log::Reset();
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
@ -0,0 +1,14 @@
|
|||||||
|
#ifndef _MSG_HPP_
|
||||||
|
#define _MSG_HPP_
|
||||||
|
|
||||||
|
#include <queue>
|
||||||
|
#include <mutex>
|
||||||
|
#include "System.hpp"
|
||||||
|
|
||||||
|
class MsgData {
|
||||||
|
public:
|
||||||
|
static std::queue<PrintReq> PrintReq_queue_;
|
||||||
|
static std::mutex queue_cv_mtx_;
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif
|
||||||
Loading…
Reference in New Issue