| 1 | #ifndef IN_OUT_INTERFACE_H
|
|---|
| 2 | #define IN_OUT_INTERFACE_H
|
|---|
| 3 |
|
|---|
| 4 | #include <Pacpus/kernel/InputOutputBase.h>
|
|---|
| 5 | #include <Pacpus/kernel/Log.h>
|
|---|
| 6 |
|
|---|
| 7 | #include <boost/function.hpp>
|
|---|
| 8 | #include <QByteArray>
|
|---|
| 9 | #include <QCoreApplication>
|
|---|
| 10 | //#include <QThread>
|
|---|
| 11 | #include <typeinfo>
|
|---|
| 12 |
|
|---|
| 13 | namespace pacpus
|
|---|
| 14 | {
|
|---|
| 15 |
|
|---|
| 16 | template <typename T, class C>
|
|---|
| 17 | class InputInterface
|
|---|
| 18 | : public InputInterfaceBase
|
|---|
| 19 | {
|
|---|
| 20 | public:
|
|---|
| 21 | typedef T data_type;
|
|---|
| 22 | typedef C component_type;
|
|---|
| 23 | typedef void (C::*process_data_function_type_with_event)(T&, PacpusEvent);
|
|---|
| 24 | typedef void (C::*process_data_function_type)(T&);
|
|---|
| 25 | typedef void (C::*process_const_data_function_type_with_event)(T const&, PacpusEvent);
|
|---|
| 26 | typedef void (C::*process_const_data_function_type)(T const&);
|
|---|
| 27 | //typedef boost::function<void (C*, T&, PacpusEvent)> process_data_function_type_with_event;
|
|---|
| 28 | //typedef boost::function<void (C*, T&)> process_data_function_type;
|
|---|
| 29 | //typedef boost::function<void (C*, T const&, PacpusEvent)> process_const_data_function_type_with_event;
|
|---|
| 30 | //typedef boost::function<void (C*, T const&)> process_const_data_function_type;
|
|---|
| 31 |
|
|---|
| 32 | void initialize()
|
|---|
| 33 | {
|
|---|
| 34 | // each input slot will be processed by a separate thread
|
|---|
| 35 | //moveToThread(&mProcessingThread);
|
|---|
| 36 | //mProcessingThread.start();
|
|---|
| 37 | }
|
|---|
| 38 |
|
|---|
| 39 | InputInterface(QString name, C* component, process_data_function_type_with_event processingMethod)
|
|---|
| 40 | : InputInterfaceBase(name, component, component)
|
|---|
| 41 | {
|
|---|
| 42 | mProcessingMethod.fe = processingMethod;
|
|---|
| 43 | initialize();
|
|---|
| 44 | }
|
|---|
| 45 |
|
|---|
| 46 | InputInterface(QString name, C* component, process_data_function_type processingMethod)
|
|---|
| 47 | : InputInterfaceBase(name, component, component)
|
|---|
| 48 | {
|
|---|
| 49 | mProcessingMethod.f = processingMethod;
|
|---|
| 50 | initialize();
|
|---|
| 51 | }
|
|---|
| 52 |
|
|---|
| 53 | InputInterface(QString name, C* component, process_const_data_function_type_with_event processingMethod)
|
|---|
| 54 | : InputInterfaceBase(name, component, component)
|
|---|
| 55 | {
|
|---|
| 56 | mProcessingMethod.cfe = processingMethod;
|
|---|
| 57 | initialize();
|
|---|
| 58 | }
|
|---|
| 59 |
|
|---|
| 60 | InputInterface(QString name, C* component, process_const_data_function_type processingMethod)
|
|---|
| 61 | : InputInterfaceBase(name, component, component)
|
|---|
| 62 | {
|
|---|
| 63 | mProcessingMethod.cf = processingMethod;
|
|---|
| 64 | initialize();
|
|---|
| 65 | }
|
|---|
| 66 |
|
|---|
| 67 | ~InputInterface()
|
|---|
| 68 | {
|
|---|
| 69 | }
|
|---|
| 70 |
|
|---|
| 71 | std::size_t getDataSize() const
|
|---|
| 72 | {
|
|---|
| 73 | return sizeof(T);
|
|---|
| 74 | }
|
|---|
| 75 |
|
|---|
| 76 | std::type_info const& getDataType() const
|
|---|
| 77 | {
|
|---|
| 78 | return typeid(T);
|
|---|
| 79 | }
|
|---|
| 80 |
|
|---|
| 81 | // FIXME: what's the purpose of this function?
|
|---|
| 82 | //PacpusEvent * getEventTemplate()
|
|---|
| 83 | //{
|
|---|
| 84 | // return new PacpusTypedEvent<T>(TYPED_EVENT);
|
|---|
| 85 | //}
|
|---|
| 86 |
|
|---|
| 87 | // FIXME: what's the purpose of this function?
|
|---|
| 88 | void customEvent(QEvent* event)
|
|---|
| 89 | {
|
|---|
| 90 | static road_timerange_t const kMaximumBoundedTimeRange = 500;
|
|---|
| 91 |
|
|---|
| 92 | if (!event) {
|
|---|
| 93 | LOG_WARN("null event");
|
|---|
| 94 | return;
|
|---|
| 95 | }
|
|---|
| 96 |
|
|---|
| 97 | // check that component has been started
|
|---|
| 98 | if ((NULL == getComponent()) || (!getComponent()->isActive())) {
|
|---|
| 99 | LOG_DEBUG("component is not active");
|
|---|
| 100 | return;
|
|---|
| 101 | }
|
|---|
| 102 |
|
|---|
| 103 | LOG_TRACE("Receiver: " << getSignature());
|
|---|
| 104 |
|
|---|
| 105 | //PacpusTypedEvent<T>* typedEvent = dynamic_cast<PacpusTypedEvent<T> *>(event);
|
|---|
| 106 | PacpusEvent* pacpusEvent = dynamic_cast<PacpusEvent*>(event);
|
|---|
| 107 | if (!pacpusEvent) {
|
|---|
| 108 | LOG_WARN("dynamic_cast failed: not a PacpusEvent");
|
|---|
| 109 | return;
|
|---|
| 110 | }
|
|---|
| 111 | PacpusTypedEvent<T>* typedEvent = dynamic_cast<PacpusTypedEvent<T>*>(pacpusEvent);
|
|---|
| 112 | if (!typedEvent) {
|
|---|
| 113 | LOG_WARN("dynamic_cast failed: incompatible event types");
|
|---|
| 114 | return;
|
|---|
| 115 | }
|
|---|
| 116 |
|
|---|
| 117 | switch (event->type()) {
|
|---|
| 118 | case TYPED_EVENT:
|
|---|
| 119 | if (TimeBounded == readingMode() && typedEvent->timerange() < kMaximumBoundedTimeRange) {
|
|---|
| 120 | LOG_WARN("Incorrect TimeRange (< " << kMaximumBoundedTimeRange << "), switching to NeverSkip mode");
|
|---|
| 121 | readingMode() = NeverSkip;
|
|---|
| 122 | }
|
|---|
| 123 |
|
|---|
| 124 | switch (readingMode()) {
|
|---|
| 125 | case TimeBounded:
|
|---|
| 126 | if (road_time() - typedEvent->time() > typedEvent->timerange()) {
|
|---|
| 127 | LOG_TRACE("Data skipped, receiver: " << this->getSignature());
|
|---|
| 128 | break;
|
|---|
| 129 | }
|
|---|
| 130 |
|
|---|
| 131 | mProcessingMethod.invoke(component(), typedEvent->data(), *typedEvent);
|
|---|
| 132 | break;
|
|---|
| 133 |
|
|---|
| 134 | case GetLast:
|
|---|
| 135 | mProcessingMethod.invoke(component(), typedEvent->data(), *typedEvent);
|
|---|
| 136 |
|
|---|
| 137 | // delete all remaining events
|
|---|
| 138 | QCoreApplication::removePostedEvents(this, TYPED_EVENT);
|
|---|
| 139 | break;
|
|---|
| 140 |
|
|---|
| 141 | case NeverSkip:
|
|---|
| 142 | mProcessingMethod.invoke(component(), typedEvent->data(), *typedEvent);
|
|---|
| 143 | break;
|
|---|
| 144 |
|
|---|
| 145 | default:
|
|---|
| 146 | LOG_WARN("Unknown reading mode " << readingMode());
|
|---|
| 147 | break;
|
|---|
| 148 | }
|
|---|
| 149 | break;
|
|---|
| 150 |
|
|---|
| 151 | // Add here new event type if needed
|
|---|
| 152 |
|
|---|
| 153 | default:
|
|---|
| 154 | LOG_WARN("Unknown event ID " << event->type());
|
|---|
| 155 | break;
|
|---|
| 156 | }
|
|---|
| 157 | event->accept();
|
|---|
| 158 | }
|
|---|
| 159 |
|
|---|
| 160 | // TODO: pull mode (NOT YET IMPLEMENTED!!!)
|
|---|
| 161 | T& getData()
|
|---|
| 162 | {
|
|---|
| 163 | T data;
|
|---|
| 164 | // TODO: ask the output data;
|
|---|
| 165 | return data;
|
|---|
| 166 | }
|
|---|
| 167 |
|
|---|
| 168 | protected:
|
|---|
| 169 | struct ProcessingMethod
|
|---|
| 170 | {
|
|---|
| 171 | ProcessingMethod()
|
|---|
| 172 | {
|
|---|
| 173 | fe = NULL;
|
|---|
| 174 | f = NULL;
|
|---|
| 175 | cfe = NULL;
|
|---|
| 176 | cf = NULL;
|
|---|
| 177 | }
|
|---|
| 178 |
|
|---|
| 179 | void invoke(ComponentBase* component, T& data, PacpusEvent event)
|
|---|
| 180 | {
|
|---|
| 181 | C* comp = dynamic_cast<C*>(component);
|
|---|
| 182 | if (NULL == comp) {
|
|---|
| 183 | LOG_WARN("NULL component");
|
|---|
| 184 | return;
|
|---|
| 185 | }
|
|---|
| 186 | //if (fe) {
|
|---|
| 187 | // fe(comp, data, event);
|
|---|
| 188 | //} else if (f) {
|
|---|
| 189 | // f(comp, data);
|
|---|
| 190 | //} else if (cfe) {
|
|---|
| 191 | // cfe(comp, data, event);
|
|---|
| 192 | //} else if (cf) {
|
|---|
| 193 | // cf(comp, data);
|
|---|
| 194 | //} else {
|
|---|
| 195 | // LOG_WARN("no method to invoke");
|
|---|
| 196 | //}
|
|---|
| 197 | if (fe) {
|
|---|
| 198 | (comp->*fe)(data, event);
|
|---|
| 199 | } else if (f) {
|
|---|
| 200 | (comp->*f)(data);
|
|---|
| 201 | } else if (cfe) {
|
|---|
| 202 | (comp->*cfe)(data, event);
|
|---|
| 203 | } else if (cf) {
|
|---|
| 204 | (comp->*cf)(data);
|
|---|
| 205 | } else {
|
|---|
| 206 | LOG_WARN("no method to invoke");
|
|---|
| 207 | }
|
|---|
| 208 | }
|
|---|
| 209 |
|
|---|
| 210 | process_data_function_type_with_event fe;
|
|---|
| 211 | process_data_function_type f;
|
|---|
| 212 | process_const_data_function_type_with_event cfe;
|
|---|
| 213 | process_const_data_function_type cf;
|
|---|
| 214 | };
|
|---|
| 215 |
|
|---|
| 216 | ProcessingMethod mProcessingMethod;
|
|---|
| 217 | //QThread mProcessingThread;
|
|---|
| 218 | };
|
|---|
| 219 |
|
|---|
| 220 | template <typename T, class C>
|
|---|
| 221 | class OutputInterface
|
|---|
| 222 | : public OutputInterfaceBase
|
|---|
| 223 | {
|
|---|
| 224 | public:
|
|---|
| 225 | typedef T data_type;
|
|---|
| 226 | typedef C component_type;
|
|---|
| 227 |
|
|---|
| 228 | OutputInterface(QString name, C* component)
|
|---|
| 229 | : OutputInterfaceBase(name, component, component)
|
|---|
| 230 | {}
|
|---|
| 231 |
|
|---|
| 232 | ~OutputInterface()
|
|---|
| 233 | {}
|
|---|
| 234 |
|
|---|
| 235 | /// Send data through a typed output
|
|---|
| 236 | void send(T const& data, road_time_t t = road_time(), road_timerange_t tr = 0);
|
|---|
| 237 |
|
|---|
| 238 | std::size_t getDataSize() const
|
|---|
| 239 | {
|
|---|
| 240 | return sizeof(T);
|
|---|
| 241 | }
|
|---|
| 242 |
|
|---|
| 243 | std::type_info const& getDataType() const
|
|---|
| 244 | {
|
|---|
| 245 | return typeid(T);
|
|---|
| 246 | }
|
|---|
| 247 | };
|
|---|
| 248 |
|
|---|
| 249 | template <typename T, class C>
|
|---|
| 250 | void OutputInterface<T, C>::send(T const& data, road_time_t t, road_timerange_t tr)
|
|---|
| 251 | {
|
|---|
| 252 | // FIXME: use shared data
|
|---|
| 253 | //QSharedPointer<T> sharedPointer = new T(data);
|
|---|
| 254 |
|
|---|
| 255 | for (QList<ConnectionBase>::iterator it = connections().begin(), itend = connections().end(); it != itend; ++it) {
|
|---|
| 256 | // Qt documentation:
|
|---|
| 257 | // The event must be allocated on the heap since the post event queue will take ownership of the event and delete it once it has been posted.
|
|---|
| 258 | // It is not safe to access the event after it has been posted.
|
|---|
| 259 | QEvent* pacpusEvent = new PacpusTypedEvent<T>(TYPED_EVENT, data, t, tr);
|
|---|
| 260 | QCoreApplication::postEvent(
|
|---|
| 261 | it->getInterface(),
|
|---|
| 262 | pacpusEvent,
|
|---|
| 263 | it->getPriority()
|
|---|
| 264 | );
|
|---|
| 265 | LOG_TRACE("Sending from " << getSignature() << " to " << it->getInterface()->getSignature());
|
|---|
| 266 | }
|
|---|
| 267 | }
|
|---|
| 268 |
|
|---|
| 269 | template <typename T1, typename T2, class C>
|
|---|
| 270 | bool checkedSend(OutputInterface<T1, C>* sender, T2 const& data, road_time_t t = road_time(), road_timerange_t tr = 0);
|
|---|
| 271 |
|
|---|
| 272 | template <typename T1, typename T2, class C>
|
|---|
| 273 | bool checkedSend(OutputInterface<T1, C>* sender, T2 const& data, road_time_t t, road_timerange_t tr)
|
|---|
| 274 | {
|
|---|
| 275 | if (sender && sender->hasConnection()) {
|
|---|
| 276 | sender->send(data, t, tr);
|
|---|
| 277 | return true;
|
|---|
| 278 | }
|
|---|
| 279 | return false;
|
|---|
| 280 | }
|
|---|
| 281 |
|
|---|
| 282 | //template <typename T1, typename T2, class C>
|
|---|
| 283 | //bool checkedSend(boost::shared_ptr< OutputInterface<T1, C> > sender, T2 const& data, road_time_t t = road_time(), road_timerange_t tr = 0);
|
|---|
| 284 | //
|
|---|
| 285 | //template <typename T1, typename T2, class C>
|
|---|
| 286 | //bool checkedSend(boost::shared_ptr< OutputInterface<T1, C> > sender, T2 const& data, road_time_t t, road_timerange_t tr)
|
|---|
| 287 | //{
|
|---|
| 288 | // return checkedSend(sender.get(), data, t, tr);
|
|---|
| 289 | //}
|
|---|
| 290 |
|
|---|
| 291 | } // namespace pacpus
|
|---|
| 292 |
|
|---|
| 293 | #endif // IN_OUT_INTERFACE_H
|
|---|