Porting mros2 as an Mbed library.
Dependents: mbed-os-example-mros2 example-mbed-mros2-sub-pose example-mbed-mros2-pub-twist example-mbed-mros2-mturtle-teleop
custom_msgs/geometry_msgs/msg/quaternion.hpp
- Committer:
- smoritaemb
- Date:
- 2022-03-19
- Revision:
- 7:c80f65422d99
- Parent:
- 3:aaf6422e0be9
File content as of revision 7:c80f65422d99:
#ifndef _GEOMETRY_MSGS_MSG_QUATERNION_H #define _GEOMETRY_MSGS_MSG_QUATERNION_H #include <iostream> #include <string> using namespace std; namespace geometry_msgs { namespace msg { class Quaternion { public: uint32_t cntPub = 0; uint32_t cntSub = 0; double x ; double y ; double z ; double w; uint32_t copyToBuf(uint8_t *addrPtr) { uint32_t tmpPub = 0; uint32_t arraySize; uint32_t stringSize; if (cntPub%8 > 0){ for(int i=0; i<(8-(cntPub%8)) ; i++){ *addrPtr = 0; addrPtr += 1; } cntPub += 8-(cntPub%8); } memcpy(addrPtr,&x ,8); addrPtr += 8; cntPub += 8; if (cntPub%8 > 0){ for(int i=0; i<(8-(cntPub%8)) ; i++){ *addrPtr = 0; addrPtr += 1; } cntPub += 8-(cntPub%8); } memcpy(addrPtr,&y ,8); addrPtr += 8; cntPub += 8; if (cntPub%8 > 0){ for(int i=0; i<(8-(cntPub%8)) ; i++){ *addrPtr = 0; addrPtr += 1; } cntPub += 8-(cntPub%8); } memcpy(addrPtr,&z ,8); addrPtr += 8; cntPub += 8; if (cntPub%8 > 0){ for(int i=0; i<(8-(cntPub%8)) ; i++){ *addrPtr = 0; addrPtr += 1; } cntPub += 8-(cntPub%8); } memcpy(addrPtr,&w,8); addrPtr += 8; cntPub += 8; return cntPub; } uint32_t copyFromBuf(const uint8_t *addrPtr) { uint32_t tmpSub = 0; uint32_t arraySize; uint32_t stringSize; if (cntSub%8 > 0){ for(int i=0; i<(8-(cntSub%8)) ; i++){ addrPtr += 1; } cntSub += 8-(cntSub%8); } memcpy(&x ,addrPtr,8); addrPtr += 8; cntSub += 8; if (cntSub%8 > 0){ for(int i=0; i<(8-(cntSub%8)) ; i++){ addrPtr += 1; } cntSub += 8-(cntSub%8); } memcpy(&y ,addrPtr,8); addrPtr += 8; cntSub += 8; if (cntSub%8 > 0){ for(int i=0; i<(8-(cntSub%8)) ; i++){ addrPtr += 1; } cntSub += 8-(cntSub%8); } memcpy(&z ,addrPtr,8); addrPtr += 8; cntSub += 8; if (cntSub%8 > 0){ for(int i=0; i<(8-(cntSub%8)) ; i++){ addrPtr += 1; } cntSub += 8-(cntSub%8); } memcpy(&w,addrPtr,8); addrPtr += 8; cntSub += 8; return cntSub; } void memAlign(uint8_t *addrPtr){ if (cntPub%4 > 0){ addrPtr += cntPub; for(int i=0; i<(4-(cntPub%4)) ; i++){ *addrPtr = 0; addrPtr += 1; } cntPub += 4-(cntPub%4); } return; } uint32_t getTotalSize(){ uint32_t tmpCntPub = cntPub; cntPub = 0; return tmpCntPub ; } private: std::string type_name = "geometry_msgs::msg::dds_::Quaternion"; }; }; } namespace message_traits { template<> struct TypeName<geometry_msgs::msg::Quaternion*> { static const char* value() { return "geometry_msgs::msg::dds_::Quaternion_"; } }; } #endif