Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
ros_lib_melodic/topic_tools/DemuxSelect.h@9:859bcb293e46, 2020-07-30 (annotated)
- Committer:
- ruslanbredun
- Date:
- Thu Jul 30 13:04:10 2020 +0000
- Revision:
- 9:859bcb293e46
- Parent:
- 2:b7fdc74e5c5d
rs485 request and send first test
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| ommpy | 2:b7fdc74e5c5d | 1 | #ifndef _ROS_SERVICE_DemuxSelect_h |
| ommpy | 2:b7fdc74e5c5d | 2 | #define _ROS_SERVICE_DemuxSelect_h |
| ommpy | 2:b7fdc74e5c5d | 3 | #include <stdint.h> |
| ommpy | 2:b7fdc74e5c5d | 4 | #include <string.h> |
| ommpy | 2:b7fdc74e5c5d | 5 | #include <stdlib.h> |
| ommpy | 2:b7fdc74e5c5d | 6 | #include "ros/msg.h" |
| ommpy | 2:b7fdc74e5c5d | 7 | |
| ommpy | 2:b7fdc74e5c5d | 8 | namespace topic_tools |
| ommpy | 2:b7fdc74e5c5d | 9 | { |
| ommpy | 2:b7fdc74e5c5d | 10 | |
| ommpy | 2:b7fdc74e5c5d | 11 | static const char DEMUXSELECT[] = "topic_tools/DemuxSelect"; |
| ommpy | 2:b7fdc74e5c5d | 12 | |
| ommpy | 2:b7fdc74e5c5d | 13 | class DemuxSelectRequest : public ros::Msg |
| ommpy | 2:b7fdc74e5c5d | 14 | { |
| ommpy | 2:b7fdc74e5c5d | 15 | public: |
| ommpy | 2:b7fdc74e5c5d | 16 | typedef const char* _topic_type; |
| ommpy | 2:b7fdc74e5c5d | 17 | _topic_type topic; |
| ommpy | 2:b7fdc74e5c5d | 18 | |
| ommpy | 2:b7fdc74e5c5d | 19 | DemuxSelectRequest(): |
| ommpy | 2:b7fdc74e5c5d | 20 | topic("") |
| ommpy | 2:b7fdc74e5c5d | 21 | { |
| ommpy | 2:b7fdc74e5c5d | 22 | } |
| ommpy | 2:b7fdc74e5c5d | 23 | |
| ommpy | 2:b7fdc74e5c5d | 24 | virtual int serialize(unsigned char *outbuffer) const |
| ommpy | 2:b7fdc74e5c5d | 25 | { |
| ommpy | 2:b7fdc74e5c5d | 26 | int offset = 0; |
| ommpy | 2:b7fdc74e5c5d | 27 | uint32_t length_topic = strlen(this->topic); |
| ommpy | 2:b7fdc74e5c5d | 28 | varToArr(outbuffer + offset, length_topic); |
| ommpy | 2:b7fdc74e5c5d | 29 | offset += 4; |
| ommpy | 2:b7fdc74e5c5d | 30 | memcpy(outbuffer + offset, this->topic, length_topic); |
| ommpy | 2:b7fdc74e5c5d | 31 | offset += length_topic; |
| ommpy | 2:b7fdc74e5c5d | 32 | return offset; |
| ommpy | 2:b7fdc74e5c5d | 33 | } |
| ommpy | 2:b7fdc74e5c5d | 34 | |
| ommpy | 2:b7fdc74e5c5d | 35 | virtual int deserialize(unsigned char *inbuffer) |
| ommpy | 2:b7fdc74e5c5d | 36 | { |
| ommpy | 2:b7fdc74e5c5d | 37 | int offset = 0; |
| ommpy | 2:b7fdc74e5c5d | 38 | uint32_t length_topic; |
| ommpy | 2:b7fdc74e5c5d | 39 | arrToVar(length_topic, (inbuffer + offset)); |
| ommpy | 2:b7fdc74e5c5d | 40 | offset += 4; |
| ommpy | 2:b7fdc74e5c5d | 41 | for(unsigned int k= offset; k< offset+length_topic; ++k){ |
| ommpy | 2:b7fdc74e5c5d | 42 | inbuffer[k-1]=inbuffer[k]; |
| ommpy | 2:b7fdc74e5c5d | 43 | } |
| ommpy | 2:b7fdc74e5c5d | 44 | inbuffer[offset+length_topic-1]=0; |
| ommpy | 2:b7fdc74e5c5d | 45 | this->topic = (char *)(inbuffer + offset-1); |
| ommpy | 2:b7fdc74e5c5d | 46 | offset += length_topic; |
| ommpy | 2:b7fdc74e5c5d | 47 | return offset; |
| ommpy | 2:b7fdc74e5c5d | 48 | } |
| ommpy | 2:b7fdc74e5c5d | 49 | |
| ommpy | 2:b7fdc74e5c5d | 50 | const char * getType(){ return DEMUXSELECT; }; |
| ommpy | 2:b7fdc74e5c5d | 51 | const char * getMD5(){ return "d8f94bae31b356b24d0427f80426d0c3"; }; |
| ommpy | 2:b7fdc74e5c5d | 52 | |
| ommpy | 2:b7fdc74e5c5d | 53 | }; |
| ommpy | 2:b7fdc74e5c5d | 54 | |
| ommpy | 2:b7fdc74e5c5d | 55 | class DemuxSelectResponse : public ros::Msg |
| ommpy | 2:b7fdc74e5c5d | 56 | { |
| ommpy | 2:b7fdc74e5c5d | 57 | public: |
| ommpy | 2:b7fdc74e5c5d | 58 | typedef const char* _prev_topic_type; |
| ommpy | 2:b7fdc74e5c5d | 59 | _prev_topic_type prev_topic; |
| ommpy | 2:b7fdc74e5c5d | 60 | |
| ommpy | 2:b7fdc74e5c5d | 61 | DemuxSelectResponse(): |
| ommpy | 2:b7fdc74e5c5d | 62 | prev_topic("") |
| ommpy | 2:b7fdc74e5c5d | 63 | { |
| ommpy | 2:b7fdc74e5c5d | 64 | } |
| ommpy | 2:b7fdc74e5c5d | 65 | |
| ommpy | 2:b7fdc74e5c5d | 66 | virtual int serialize(unsigned char *outbuffer) const |
| ommpy | 2:b7fdc74e5c5d | 67 | { |
| ommpy | 2:b7fdc74e5c5d | 68 | int offset = 0; |
| ommpy | 2:b7fdc74e5c5d | 69 | uint32_t length_prev_topic = strlen(this->prev_topic); |
| ommpy | 2:b7fdc74e5c5d | 70 | varToArr(outbuffer + offset, length_prev_topic); |
| ommpy | 2:b7fdc74e5c5d | 71 | offset += 4; |
| ommpy | 2:b7fdc74e5c5d | 72 | memcpy(outbuffer + offset, this->prev_topic, length_prev_topic); |
| ommpy | 2:b7fdc74e5c5d | 73 | offset += length_prev_topic; |
| ommpy | 2:b7fdc74e5c5d | 74 | return offset; |
| ommpy | 2:b7fdc74e5c5d | 75 | } |
| ommpy | 2:b7fdc74e5c5d | 76 | |
| ommpy | 2:b7fdc74e5c5d | 77 | virtual int deserialize(unsigned char *inbuffer) |
| ommpy | 2:b7fdc74e5c5d | 78 | { |
| ommpy | 2:b7fdc74e5c5d | 79 | int offset = 0; |
| ommpy | 2:b7fdc74e5c5d | 80 | uint32_t length_prev_topic; |
| ommpy | 2:b7fdc74e5c5d | 81 | arrToVar(length_prev_topic, (inbuffer + offset)); |
| ommpy | 2:b7fdc74e5c5d | 82 | offset += 4; |
| ommpy | 2:b7fdc74e5c5d | 83 | for(unsigned int k= offset; k< offset+length_prev_topic; ++k){ |
| ommpy | 2:b7fdc74e5c5d | 84 | inbuffer[k-1]=inbuffer[k]; |
| ommpy | 2:b7fdc74e5c5d | 85 | } |
| ommpy | 2:b7fdc74e5c5d | 86 | inbuffer[offset+length_prev_topic-1]=0; |
| ommpy | 2:b7fdc74e5c5d | 87 | this->prev_topic = (char *)(inbuffer + offset-1); |
| ommpy | 2:b7fdc74e5c5d | 88 | offset += length_prev_topic; |
| ommpy | 2:b7fdc74e5c5d | 89 | return offset; |
| ommpy | 2:b7fdc74e5c5d | 90 | } |
| ommpy | 2:b7fdc74e5c5d | 91 | |
| ommpy | 2:b7fdc74e5c5d | 92 | const char * getType(){ return DEMUXSELECT; }; |
| ommpy | 2:b7fdc74e5c5d | 93 | const char * getMD5(){ return "3db0a473debdbafea387c9e49358c320"; }; |
| ommpy | 2:b7fdc74e5c5d | 94 | |
| ommpy | 2:b7fdc74e5c5d | 95 | }; |
| ommpy | 2:b7fdc74e5c5d | 96 | |
| ommpy | 2:b7fdc74e5c5d | 97 | class DemuxSelect { |
| ommpy | 2:b7fdc74e5c5d | 98 | public: |
| ommpy | 2:b7fdc74e5c5d | 99 | typedef DemuxSelectRequest Request; |
| ommpy | 2:b7fdc74e5c5d | 100 | typedef DemuxSelectResponse Response; |
| ommpy | 2:b7fdc74e5c5d | 101 | }; |
| ommpy | 2:b7fdc74e5c5d | 102 | |
| ommpy | 2:b7fdc74e5c5d | 103 | } |
| ommpy | 2:b7fdc74e5c5d | 104 | #endif |