[4850] | 1 | // [License]
|
---|
| 2 | // The Ariba-Underlay Copyright
|
---|
| 3 | //
|
---|
| 4 | // Copyright (c) 2008-2009, Institute of Telematics, UniversitÀt Karlsruhe (TH)
|
---|
| 5 | //
|
---|
| 6 | // Institute of Telematics
|
---|
| 7 | // UniversitÀt Karlsruhe (TH)
|
---|
| 8 | // Zirkel 2, 76128 Karlsruhe
|
---|
| 9 | // Germany
|
---|
| 10 | //
|
---|
| 11 | // Redistribution and use in source and binary forms, with or without
|
---|
| 12 | // modification, are permitted provided that the following conditions are
|
---|
| 13 | // met:
|
---|
| 14 | //
|
---|
| 15 | // 1. Redistributions of source code must retain the above copyright
|
---|
| 16 | // notice, this list of conditions and the following disclaimer.
|
---|
| 17 | // 2. Redistributions in binary form must reproduce the above copyright
|
---|
| 18 | // notice, this list of conditions and the following disclaimer in the
|
---|
| 19 | // documentation and/or other materials provided with the distribution.
|
---|
| 20 | //
|
---|
| 21 | // THIS SOFTWARE IS PROVIDED BY THE INSTITUTE OF TELEMATICS ``AS IS'' AND
|
---|
| 22 | // ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
---|
| 23 | // IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
---|
| 24 | // PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE ARIBA PROJECT OR
|
---|
| 25 | // CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
---|
| 26 | // EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
---|
| 27 | // PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
---|
| 28 | // PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
---|
| 29 | // LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
---|
| 30 | // NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
---|
| 31 | // SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
---|
| 32 | //
|
---|
| 33 | // The views and conclusions contained in the software and documentation
|
---|
| 34 | // are those of the authors and should not be interpreted as representing
|
---|
| 35 | // official policies, either expressed or implied, of the Institute of
|
---|
| 36 | // Telematics.
|
---|
| 37 | // [License]
|
---|
| 38 |
|
---|
| 39 | #ifndef __PERIODIC_BROADCAST_H
|
---|
| 40 | #define __PERIODIC_BROADCAST_H
|
---|
| 41 |
|
---|
| 42 | #include "ariba/config.h"
|
---|
| 43 |
|
---|
[4851] | 44 | #include <map>
|
---|
| 45 | #include <string>
|
---|
[4866] | 46 | #include <ctime>
|
---|
[4850] | 47 | #include <iostream>
|
---|
[4853] | 48 | #include <boost/asio.hpp>
|
---|
[4851] | 49 | #include <boost/foreach.hpp>
|
---|
[4850] | 50 | #include <boost/thread/mutex.hpp>
|
---|
| 51 | #include <boost/thread/thread.hpp>
|
---|
| 52 | #include "ariba/utility/bootstrap/modules/BootstrapModule.h"
|
---|
| 53 | #include "ariba/utility/logging/Logging.h"
|
---|
| 54 | #include "ariba/utility/system/Timer.h"
|
---|
[4853] | 55 | #include "PeriodicBroadcastMessage.h"
|
---|
[4850] | 56 |
|
---|
| 57 | using std::map;
|
---|
| 58 | using std::string;
|
---|
[4866] | 59 | using std::cout;
|
---|
[4853] | 60 | using boost::asio::ip::udp;
|
---|
[4850] | 61 |
|
---|
| 62 | namespace ariba {
|
---|
| 63 | namespace utility {
|
---|
| 64 |
|
---|
| 65 | class PeriodicBroadcast : public BootstrapModule, public Timer {
|
---|
| 66 | use_logging_h(PeriodicBroadcast);
|
---|
| 67 | public:
|
---|
| 68 | PeriodicBroadcast(BootstrapInformationCallback* _callback);
|
---|
| 69 | virtual ~PeriodicBroadcast();
|
---|
| 70 |
|
---|
| 71 | virtual void start();
|
---|
| 72 | virtual void stop();
|
---|
| 73 |
|
---|
| 74 | virtual string getName();
|
---|
| 75 | virtual string getInformation();
|
---|
| 76 | virtual bool isFunctional();
|
---|
| 77 | virtual void publishService(string name, string info1, string info2, string info3);
|
---|
| 78 | virtual void revokeService(string name);
|
---|
| 79 |
|
---|
| 80 | protected:
|
---|
| 81 | virtual void eventFunction();
|
---|
| 82 |
|
---|
| 83 | private:
|
---|
| 84 | void sendLocalServices();
|
---|
| 85 | void updateRemoteServices();
|
---|
| 86 |
|
---|
[4866] | 87 | static const long timerinterval; // used to send out updates on our services and check for new services
|
---|
| 88 | static const long servicetimeout; // timeout after that a service is dead when we did not receive updates
|
---|
[4853] | 89 | static const unsigned int serverport_v4;
|
---|
| 90 | static const unsigned int serverport_v6;
|
---|
[4850] | 91 |
|
---|
| 92 | typedef struct _Service {
|
---|
| 93 | string name;
|
---|
| 94 | string info1;
|
---|
| 95 | string info2;
|
---|
| 96 | string info3;
|
---|
[4866] | 97 | time_t lastseen;
|
---|
| 98 |
|
---|
| 99 | _Service()
|
---|
| 100 | : name(""), info1(""), info2(""), info3(""), lastseen(0){
|
---|
| 101 | }
|
---|
[5414] | 102 |
|
---|
| 103 | _Service(const _Service& rh)
|
---|
| 104 | : name(rh.name), info1(rh.info1), info2(rh.info2),
|
---|
| 105 | info3(rh.info3), lastseen(rh.lastseen){
|
---|
| 106 | }
|
---|
[4850] | 107 | } Service;
|
---|
| 108 |
|
---|
| 109 | typedef map<string,Service> ServiceList;
|
---|
| 110 | ServiceList localServices;
|
---|
| 111 | boost::mutex localServicesMutex;
|
---|
| 112 |
|
---|
[4853] | 113 | ServiceList remoteServices;
|
---|
| 114 | boost::mutex remoteServicesMutex;
|
---|
| 115 |
|
---|
| 116 | ServiceList newRemoteServices;
|
---|
| 117 | boost::mutex newRemoteServicesMutex;
|
---|
| 118 |
|
---|
| 119 | boost::asio::io_service io_service;
|
---|
[4924] | 120 | boost::thread* io_service_thread;
|
---|
| 121 | static void threadFunc(PeriodicBroadcast* obj);
|
---|
[4853] | 122 |
|
---|
| 123 | class udp_server {
|
---|
| 124 | private:
|
---|
[4920] | 125 | udp::socket socket_v4;
|
---|
| 126 | udp::socket socket_v6;
|
---|
[4853] | 127 | udp::endpoint remote_endpoint_;
|
---|
| 128 | boost::array<char, 1500> recv_buffer_;
|
---|
| 129 | ServiceList* services;
|
---|
| 130 | boost::mutex* servicesmutex;
|
---|
| 131 |
|
---|
| 132 | public:
|
---|
| 133 | udp_server(boost::asio::io_service& io_service, ServiceList* _services, boost::mutex* _servicesmutex)
|
---|
[4872] | 134 | : services(_services), servicesmutex(_servicesmutex),
|
---|
[4920] | 135 | socket_v4(io_service), socket_v6(io_service) {
|
---|
[4853] | 136 |
|
---|
[4872] | 137 | boost::asio::ip::udp::endpoint listen_endpoint_v4(
|
---|
[4920] | 138 | boost::asio::ip::address_v4::any(),
|
---|
[4872] | 139 | PeriodicBroadcast::serverport_v4);
|
---|
[4853] | 140 |
|
---|
[4872] | 141 | boost::asio::ip::udp::endpoint listen_endpoint_v6(
|
---|
[4920] | 142 | boost::asio::ip::address_v6::any(),
|
---|
[4872] | 143 | PeriodicBroadcast::serverport_v6);
|
---|
| 144 |
|
---|
[4896] | 145 | boost::system::error_code err;
|
---|
[4872] | 146 |
|
---|
[4920] | 147 | err = socket_v4.open( listen_endpoint_v4.protocol(), err );
|
---|
| 148 | if(err) logging_warn("failed opening ipv4 socket");
|
---|
[4872] | 149 |
|
---|
[4920] | 150 | err = socket_v6.open( listen_endpoint_v6.protocol(), err );
|
---|
| 151 | if(err) logging_warn("failed opening ipv6 socket");
|
---|
[4872] | 152 |
|
---|
[4920] | 153 | err = socket_v4.set_option( boost::asio::ip::udp::socket::reuse_address(true), err );
|
---|
| 154 | if(err) logging_warn("failed setting reuse address option on ipv4 socket");
|
---|
[4896] | 155 |
|
---|
[4920] | 156 | err = socket_v6.set_option( boost::asio::ip::udp::socket::reuse_address(true), err );
|
---|
| 157 | if(err) logging_warn("failed setting reuse address option on ipv6 socket");
|
---|
[4896] | 158 |
|
---|
[4920] | 159 | err = socket_v4.set_option( boost::asio::socket_base::broadcast(true), err );
|
---|
| 160 | if(err) logging_warn("failed setting broadcast option on ipv4 socket");
|
---|
[4896] | 161 |
|
---|
[4920] | 162 | err = socket_v6.set_option( boost::asio::socket_base::broadcast(true), err );
|
---|
| 163 | if(err) logging_warn("failed setting broadcast option on ipv6 socket");
|
---|
[4896] | 164 |
|
---|
[4920] | 165 | err = socket_v4.bind( listen_endpoint_v4, err );
|
---|
| 166 | if(err) logging_warn("failed binding ipv4 socket");
|
---|
[4872] | 167 |
|
---|
[4921] | 168 | err = socket_v6.bind( listen_endpoint_v6, err );
|
---|
[4920] | 169 | if(err) logging_warn("failed binding ipv6 socket");
|
---|
| 170 |
|
---|
[4853] | 171 | start_receive();
|
---|
| 172 | }
|
---|
| 173 |
|
---|
| 174 | void sendservice(Service service){
|
---|
| 175 |
|
---|
| 176 | PeriodicBroadcastMessage msg( service.name, service.info1, service.info2, service.info3 );
|
---|
| 177 | Data data = data_serialize( msg, DEFAULT_V );
|
---|
| 178 | uint8_t* pnt = data.getBuffer();
|
---|
[4866] | 179 | size_t len = data.getLength() / 8;
|
---|
[4853] | 180 |
|
---|
[4896] | 181 | boost::system::error_code err;
|
---|
[4866] | 182 |
|
---|
[4853] | 183 | {
|
---|
| 184 | udp::endpoint endp(udp::v4(), PeriodicBroadcast::serverport_v4);
|
---|
| 185 | endp.address( boost::asio::ip::address_v4::broadcast() );
|
---|
[4920] | 186 | socket_v4.send_to( boost::asio::buffer(pnt, len), endp, 0, err );
|
---|
[4896] | 187 | if(err) logging_warn("failed sending message through ipv4 socket");
|
---|
[4853] | 188 | }
|
---|
[4920] | 189 | {
|
---|
[4853] | 190 | udp::endpoint endp(udp::v6(), PeriodicBroadcast::serverport_v6);
|
---|
| 191 | endp.address( boost::asio::ip::address_v6::from_string("ff02::1") );
|
---|
[4933] | 192 | socket_v6.send_to( boost::asio::buffer(pnt, len), endp, 0, err );
|
---|
| 193 | if(err) logging_warn("failed sending message through ipv6 socket");
|
---|
[4920] | 194 | }
|
---|
[4853] | 195 | }
|
---|
| 196 |
|
---|
| 197 | private:
|
---|
| 198 | void start_receive(){
|
---|
[4920] | 199 | socket_v4.async_receive_from(
|
---|
[4853] | 200 | boost::asio::buffer(recv_buffer_), remote_endpoint_,
|
---|
| 201 | boost::bind(&udp_server::handle_receive, this,
|
---|
| 202 | boost::asio::placeholders::error,
|
---|
| 203 | boost::asio::placeholders::bytes_transferred));
|
---|
[4920] | 204 |
|
---|
[4853] | 205 | socket_v6.async_receive_from(
|
---|
| 206 | boost::asio::buffer(recv_buffer_), remote_endpoint_,
|
---|
| 207 | boost::bind(&udp_server::handle_receive, this,
|
---|
| 208 | boost::asio::placeholders::error,
|
---|
| 209 | boost::asio::placeholders::bytes_transferred));
|
---|
| 210 | }
|
---|
| 211 |
|
---|
| 212 | void handle_receive(const boost::system::error_code& error,
|
---|
| 213 | std::size_t bytes_transferred){
|
---|
| 214 |
|
---|
| 215 | if (!error || error == boost::asio::error::message_size){
|
---|
| 216 |
|
---|
| 217 | PeriodicBroadcastMessage msg;
|
---|
| 218 | Data data( (uint8_t*)recv_buffer_.data(), bytes_transferred*8 );
|
---|
| 219 | data_deserialize( msg, data );
|
---|
| 220 |
|
---|
| 221 | { // insert new found service
|
---|
| 222 | boost::mutex::scoped_lock( *servicesmutex );
|
---|
| 223 |
|
---|
| 224 | ServiceList::iterator it = services->find( msg.getName() );
|
---|
| 225 | if( it != services->end() ) services->erase( it );
|
---|
| 226 |
|
---|
| 227 | Service s;
|
---|
| 228 | s.info1 = msg.getInfo1();
|
---|
| 229 | s.info2 = msg.getInfo2();
|
---|
| 230 | s.info3 = msg.getInfo3();
|
---|
[4866] | 231 | s.lastseen = time(NULL);
|
---|
[4853] | 232 | services->insert( std::make_pair(msg.getName(), s) );
|
---|
| 233 | }
|
---|
| 234 |
|
---|
| 235 | start_receive();
|
---|
[4896] | 236 | } else {
|
---|
| 237 |
|
---|
| 238 | logging_warn("failed receiving message on ipv4 socket" << error);
|
---|
| 239 |
|
---|
[4853] | 240 | }
|
---|
| 241 | }
|
---|
| 242 |
|
---|
| 243 | void handle_send(boost::shared_ptr<std::string> /*message*/,
|
---|
[4896] | 244 | const boost::system::error_code& error,
|
---|
[4853] | 245 | std::size_t /*bytes_transferred*/){
|
---|
[4920] | 246 |
|
---|
[4896] | 247 | if(error)
|
---|
| 248 | logging_warn("failed sending out message");
|
---|
[4920] | 249 |
|
---|
[4853] | 250 | }
|
---|
| 251 |
|
---|
| 252 | };
|
---|
| 253 |
|
---|
| 254 | udp_server server;
|
---|
[4920] | 255 |
|
---|
[4850] | 256 | };
|
---|
| 257 |
|
---|
| 258 | }} //namespace ariba, utility
|
---|
| 259 |
|
---|
| 260 | #endif // __BLUETOOTH_SDP_H
|
---|