Wiselib: wiselib.testing/algorithms/localization/greedyloc/greedyloc

Wiselib
00001 /***************************************************************************
00002  ** This file is part of the generic algorithm library Wiselib.           **
00003  ** Copyright (C) 2008,2009 by the Wisebed (www.wisebed.eu) project.      **
00004  **                                                                       **
00005  ** The Wiselib is free software: you can redistribute it and/or modify   **
00006  ** it under the terms of the GNU Lesser General Public License as        **
00007  ** published by the Free Software Foundation, either version 3 of the    **
00008  ** License, or (at your option) any later version.                       **
00009  **                                                                       **
00010  ** The Wiselib is distributed in the hope that it will be useful,        **
00011  ** but WITHOUT ANY WARRANTY; without even the implied warranty of        **
00012  ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the         **
00013  ** GNU Lesser General Public License for more details.                   **
00014  **                                                                       **
00015  ** You should have received a copy of the GNU Lesser General Public      **
00016  ** License along with the Wiselib.                                       **
00017  ** If not, see <http://www.gnu.org/licenses/>.                           **
00018  ***************************************************************************/
00019 #ifndef __GREEDYLOC_MSG_H__
00020 #define __GREEDYLOC_MSG_H__
00021 
00022 #include "util/serialization/simple_types.h"
00023 
00024 namespace wiselib
00025 {
00026 
00027    template<typename OsModel_P,
00028          typename Node_P,
00029             typename Radio_P>
00030    class Greedyloc_Message
00031    {
00032    public:
00033       typedef OsModel_P OsModel;
00034      typedef Node_P Node;
00035       typedef Radio_P Radio;
00036       typedef typename Radio::block_data_t block_data_t;
00037       typedef typename Radio::size_t size_t;
00038       typedef typename Radio::message_id_t message_id_t;
00039       // --------------------------------------------------------------------
00040       inline Greedyloc_Message();
00041       // --------------------------------------------------------------------
00042       inline message_id_t msg_id()
00043       { return read<OsModel, block_data_t, message_id_t>( buffer ); }
00044       // --------------------------------------------------------------------
00045       inline void set_msg_id( message_id_t id )
00046       { write<OsModel, block_data_t, message_id_t>( buffer, id ); }
00047      // --------------------------------------------------------------------
00048       inline Node node()
00049       { return read<OsModel, block_data_t, Node>( buffer + NODE_POS ); }
00050       // --------------------------------------------------------------------
00051       inline void set_node( Node n )
00052       { write<OsModel, block_data_t, Node>( buffer + NODE_POS, n ); }
00053      // --------------------------------------------------------------------
00054       inline size_t payload_size()
00055       { return read<OsModel, block_data_t, size_t>(buffer + PAYLOAD_POS); }
00056       // --------------------------------------------------------------------
00057       inline block_data_t* payload()
00058       { return buffer + PAYLOAD_POS + sizeof(size_t); }
00059       // --------------------------------------------------------------------
00060       inline void set_payload( size_t len, block_data_t *buf )
00061       {
00062          write<OsModel, block_data_t, size_t>(buffer + PAYLOAD_POS, len);
00063          memcpy( buffer + PAYLOAD_POS + sizeof(size_t), buf, len);
00064       }
00065       // --------------------------------------------------------------------
00066       inline size_t buffer_size()
00067       { return PAYLOAD_POS + sizeof(size_t) + payload_size(); }
00068 
00069    private:
00070       enum data_positions
00071       {
00072         MESSAGE_ID_POS = 0,
00073         NODE_POS = MESSAGE_ID_POS + sizeof(message_id_t),
00074         PAYLOAD_POS = NODE_POS + sizeof(Node)
00075 
00076       };
00077 
00078       block_data_t buffer[Radio::MAX_MESSAGE_LENGTH];
00079    };
00080    // -----------------------------------------------------------------------
00081    template<typename OsModel_P,
00082            typename Node_P,
00083             typename Radio_P>
00084    Greedyloc_Message<OsModel_P, Node_P, Radio_P>::
00085    Greedyloc_Message()
00086    {
00087       set_msg_id( 0 );
00088       size_t len = 0;
00089       write<OsModel, block_data_t, size_t>(buffer + PAYLOAD_POS, len);
00090    }
00091 
00092 }
00093 #endif