.. _program_listing_file__tmp_ws_src_kobuki_core_include_kobuki_core_packets_dock_ir.hpp: Program Listing for File dock_ir.hpp ==================================== |exhale_lsh| :ref:`Return to documentation for file ` (``/tmp/ws/src/kobuki_core/include/kobuki_core/packets/dock_ir.hpp``) .. |exhale_lsh| unicode:: U+021B0 .. UPWARDS ARROW WITH TIP LEFTWARDS .. code-block:: cpp /***************************************************************************** ** Preprocessor *****************************************************************************/ #ifndef KOBUKI_CORE_DOCK_IR_DATA_HPP__ #define KOBUKI_CORE_DOCK_IR_DATA_HPP__ /***************************************************************************** ** Include *****************************************************************************/ #include "../packet_handler/payload_base.hpp" #include "../packet_handler/payload_headers.hpp" /***************************************************************************** ** Namespace *****************************************************************************/ namespace kobuki { /***************************************************************************** ** Interface *****************************************************************************/ class DockIR : public packet_handler::payloadBase { public: DockIR() : packet_handler::payloadBase(false, 3) {}; struct Data { Data() : docking(3) {} std::vector docking; } data; bool serialise(ecl::PushAndPop & byteStream) { buildBytes(Header::DockInfraRed, byteStream); buildBytes(length, byteStream); buildBytes(data.docking[0], byteStream); buildBytes(data.docking[1], byteStream); buildBytes(data.docking[2], byteStream); return true; } bool deserialise(ecl::PushAndPop & byteStream) { if (byteStream.size() < static_cast(length)+2) { //std::cout << "kobuki_node: kobuki_dock_ir: deserialise failed. not enough byte stream." << std::endl; return false; } unsigned char header_id(0x00), length_packed(0x00); buildVariable(header_id, byteStream); buildVariable(length_packed, byteStream); if( header_id != Header::DockInfraRed ) return false; if( length_packed != length ) return false; buildVariable(data.docking[0], byteStream); buildVariable(data.docking[1], byteStream); buildVariable(data.docking[2], byteStream); //showMe(); return constrain(); } bool constrain() { return true; } void showMe() { //printf("--[%02x || %03d | %03d | %03d]\n", data.bump, docking[2], docking[1], docking[0] ); } }; } // namespace kobuki #endif /* KOBUKI_CORE_IR_DATA_HPP__ */