#include <stdio.h>
#include <stdlib.h>
#ifdef RTI_VX653
#include <vThreadsData.h>
#endif
#include "Message.h"
#include "MessageSupport.h"
#include "ndds/ndds_cpp.h"
#if defined(RTI_ANDROID)
#include <stdarg.h>
typedef int (*RTIAndroidOnPrintfMethod)(const char *format, va_list ap);
static RTIAndroidOnPrintfMethod publisher_onPrintf = NULL;
#define printf Android_printf
static int Android_printf(const char *format, ...) {
int len;
va_list ap;
va_start(ap, format);
if (publisher_onPrintf!= NULL) {
len = publisher_onPrintf(format, ap);
} else {
len = vprintf(format, ap);
}
va_end(ap);
return len;
}
extern "C" void RTIAndroid_registerOnPrintf(RTIAndroidOnPrintfMethod onPrintf) {
publisher_onPrintf = onPrintf;
}
#endif
class MessageListener : public DDSDataReaderListener {
public:
virtual void on_requested_deadline_missed(
DDSDataReader* ,
const DDS_RequestedDeadlineMissedStatus& ) {}
virtual void on_requested_incompatible_qos(
DDSDataReader* ,
const DDS_RequestedIncompatibleQosStatus& ) {}
virtual void on_sample_rejected(
DDSDataReader* ,
const DDS_SampleRejectedStatus& ) {}
virtual void on_liveliness_changed(
DDSDataReader* ,
const DDS_LivelinessChangedStatus& ) {}
virtual void on_sample_lost(
DDSDataReader* ,
const DDS_SampleLostStatus& ) {}
virtual void on_subscription_matched(
DDSDataReader* ,
const DDS_SubscriptionMatchedStatus& ) {}
virtual void on_data_available(DDSDataReader* reader);
};
void MessageListener::on_data_available(DDSDataReader* reader)
{
MessageDataReader *Message_reader = NULL;
MessageSeq data_seq;
DDS_SampleInfoSeq info_seq;
DDS_ReturnCode_t retcode;
int i;
Message_reader = MessageDataReader::narrow(reader);
if (Message_reader == NULL) {
printf("DataReader narrow error\n");
return;
}
retcode = Message_reader->take(
data_seq, info_seq, DDS_LENGTH_UNLIMITED,
DDS_ANY_SAMPLE_STATE, DDS_ANY_VIEW_STATE, DDS_ANY_INSTANCE_STATE);
if (retcode == DDS_RETCODE_NO_DATA) {
return;
} else if (retcode != DDS_RETCODE_OK) {
printf("take error %d\n", retcode);
return;
}
for (i = 0; i < data_seq.length(); ++i) {
if (info_seq[i].valid_data) {
printf("Received data\n");
MessageTypeSupport::print_data(&data_seq[i]);
}
}
retcode = Message_reader->return_loan(data_seq, info_seq);
if (retcode != DDS_RETCODE_OK) {
printf("return loan error %d\n", retcode);
}
}
static int subscriber_shutdown(
DDSDomainParticipant *participant)
{
DDS_ReturnCode_t retcode;
int status = 0;
if (participant != NULL) {
retcode = participant->delete_contained_entities();
if (retcode != DDS_RETCODE_OK) {
printf("delete_contained_entities error %d\n", retcode);
status = -1;
}
retcode = DDSTheParticipantFactory->delete_participant(participant);
if (retcode != DDS_RETCODE_OK) {
printf("delete_participant error %d\n", retcode);
status = -1;
}
}
return status;
}
extern "C" int subscriber_main(int domainId, int sample_count)
{
DDSDomainParticipant *participant = NULL;
DDSSubscriber *subscriber = NULL;
DDSTopic *topic = NULL;
MessageListener *reader_listener = NULL;
DDSDataReader *reader = NULL;
DDS_ReturnCode_t retcode;
const char *type_name = NULL;
int count = 0;
DDS_Duration_t receive_period = {4,0};
int status = 0;
participant = DDSTheParticipantFactory->create_participant(
domainId, DDS_PARTICIPANT_QOS_DEFAULT,
NULL , DDS_STATUS_MASK_NONE);
if (participant == NULL) {
printf("create_participant error\n");
subscriber_shutdown(participant);
return -1;
}
subscriber = participant->create_subscriber(
DDS_SUBSCRIBER_QOS_DEFAULT, NULL , DDS_STATUS_MASK_NONE);
if (subscriber == NULL) {
printf("create_subscriber error\n");
subscriber_shutdown(participant);
return -1;
}
type_name = MessageTypeSupport::get_type_name();
retcode = MessageTypeSupport::register_type(
participant, type_name);
if (retcode != DDS_RETCODE_OK) {
printf("register_type error %d\n", retcode);
subscriber_shutdown(participant);
return -1;
}
topic = participant->create_topic(
"Example Message",
type_name, DDS_TOPIC_QOS_DEFAULT, NULL ,
DDS_STATUS_MASK_NONE);
if (topic == NULL) {
printf("create_topic error\n");
subscriber_shutdown(participant);
return -1;
}
reader_listener = new MessageListener();
reader = subscriber->create_datareader(
topic, DDS_DATAREADER_QOS_DEFAULT, reader_listener,
DDS_STATUS_MASK_ALL);
if (reader == NULL) {
printf("create_datareader error\n");
subscriber_shutdown(participant);
delete reader_listener;
return -1;
}
for (count=0; (sample_count == 0) || (count < sample_count); ++count) {
printf("Message subscriber sleeping for %d sec...\n",
receive_period.sec);
NDDSUtility::sleep(receive_period);
}
status = subscriber_shutdown(participant);
delete reader_listener;
return status;
}
#if defined(RTI_WINCE)
int wmain(int argc, wchar_t** argv)
{
int domainId = 0;
int sample_count = 0;
if (argc >= 2) {
domainId = _wtoi(argv[1]);
}
if (argc >= 3) {
sample_count = _wtoi(argv[2]);
}
return subscriber_main(domainId, sample_count);
}
#elif !(defined(RTI_VXWORKS) && !defined(__RTP__)) && !defined(RTI_PSOS)
extern "C" int main(int argc, char *argv[])
{
int domainId = 0;
int sample_count = 0;
if (argc >= 2) {
domainId = atoi(argv[1]);
}
if (argc >= 3) {
sample_count = atoi(argv[2]);
}
return subscriber_main(domainId, sample_count);
}
#endif
#ifdef RTI_VX653
const unsigned char* __ctype = *(__ctypePtrGet());
extern "C" void usrAppInit ()
{
#ifdef USER_APPL_INIT
USER_APPL_INIT;
#endif
taskSpawn("sub", RTI_OSAPI_THREAD_PRIORITY_NORMAL, 0x8, 0x150000, (FUNCPTR)subscriber_main, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0);
}
#endif