nucho / Mbed 2 deprecated rosserial_mbed

This program is porting rosserial_arduino for mbed http://www.ros.org/wiki/rosserial_arduino This program supported the revision of 169 of rosserial. This program contains an example.

Dependencies:   rosserial_mbed_lib mbed Servo

dianostic_msgs/KeyValue.h

Committer:
nucho
Date:
2011-10-16
Revision:
1:098e75fd5ad2
Parent:
0:06fc856e99ca
Child:
3:dff241b66f84

File content as of revision 1:098e75fd5ad2:

#ifndef ros_diagnostic_msgs_KeyValue_h
#define ros_diagnostic_msgs_KeyValue_h

#include <stdint.h>
#include <string.h>
#include <stdlib.h>
#include "../ros/msg.h"

namespace diagnostic_msgs {

class KeyValue : public ros::Msg {
public:
    char * key;
    char * value;

    virtual int serialize(unsigned char *outbuffer) {
        int offset = 0;
        long * length_key = (long *)(outbuffer + offset);
        *length_key = strlen( (const char*) this->key);
        offset += 4;
        memcpy(outbuffer + offset, this->key, *length_key);
        offset += *length_key;
        long * length_value = (long *)(outbuffer + offset);
        *length_value = strlen( (const char*) this->value);
        offset += 4;
        memcpy(outbuffer + offset, this->value, *length_value);
        offset += *length_value;
        return offset;
    }

    virtual int deserialize(unsigned char *inbuffer) {
        int offset = 0;
        uint32_t length_key = *(uint32_t *)(inbuffer + offset);
        offset += 4;
        for (unsigned int k= offset; k< offset+length_key; ++k) {
            inbuffer[k-1]=inbuffer[k];
        }
        inbuffer[offset+length_key-1]=0;
        this->key = (char *)(inbuffer + offset-1);
        offset += length_key;
        uint32_t length_value = *(uint32_t *)(inbuffer + offset);
        offset += 4;
        for (unsigned int k= offset; k< offset+length_value; ++k) {
            inbuffer[k-1]=inbuffer[k];
        }
        inbuffer[offset+length_value-1]=0;
        this->value = (char *)(inbuffer + offset-1);
        offset += length_value;
        return offset;
    }

    virtual const char * getType() {
        return "diagnostic_msgs/KeyValue";
    };

};

}
#endif