Rev 1959 | Rev 1987 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed
| Rev 1959 | Rev 1986 | ||
|---|---|---|---|
| 1 | /* |
1 | /* |
| 2 | * |
2 | * |
| 3 | * Copyright (C) 2010 Mattias Runge |
3 | * Copyright (C) 2010 Mattias Runge |
| 4 | * |
4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify |
5 | * This program is free software; you can redistribute it and/or modify |
| 6 | * it under the terms of the GNU General Public License as published by |
6 | * it under the terms of the GNU General Public License as published by |
| 7 | * the Free Software Foundation; either version 2 of the License, or |
7 | * the Free Software Foundation; either version 2 of the License, or |
| 8 | * (at your option) any later version. |
8 | * (at your option) any later version. |
| 9 | * |
9 | * |
| 10 | * This program is distributed in the hope that it will be useful, |
10 | * This program is distributed in the hope that it will be useful, |
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 13 | * GNU General Public License for more details. |
13 | * GNU General Public License for more details. |
| 14 | * |
14 | * |
| 15 | * You should have received a copy of the GNU General Public License along |
15 | * You should have received a copy of the GNU General Public License along |
| 16 | * with this program; if not, write to the Free Software Foundation, Inc., |
16 | * with this program; if not, write to the Free Software Foundation, Inc., |
| 17 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
17 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. |
| 18 | * |
18 | * |
| 19 | */ |
19 | */ |
| 20 | 20 | ||
| 21 | #include "CanDaemon.h" |
21 | #include "CanDaemon.h" |
| 22 | 22 | ||
| 23 | #include <boost/lexical_cast.hpp> |
23 | #include <boost/lexical_cast.hpp> |
| 24 | #include <boost/algorithm/string/trim.hpp> |
24 | #include <boost/algorithm/string/trim.hpp> |
| 25 | 25 | ||
| 26 | #include "net/Manager.h" |
26 | #include "net/Manager.h" |
| 27 | #include "broker/Manager.h" |
27 | #include "broker/Manager.h" |
| 28 | 28 | ||
| 29 | #include "Message.h" |
29 | #include "Message.h" |
| 30 | 30 | ||
| 31 | namespace atom { |
31 | namespace atom { |
| 32 | namespace can { |
32 | namespace can { |
| 33 | 33 | ||
| 34 | CanDaemon::CanDaemon(unsigned int port): broker::Subscriber(port), LOG("can::CanDaemon") |
34 | CanDaemon::CanDaemon(unsigned int port): broker::Subscriber(port), LOG("can::CanDaemon") |
| 35 | { |
35 | { |
| 36 | try |
36 | try |
| 37 | { |
37 | { |
| 38 | this->server_id_ = net::Manager::Instance()->StartServer(net::PROTOCOL_TCP, port); |
38 | this->server_id_ = net::Manager::Instance()->StartServer(net::PROTOCOL_TCP, port); |
| 39 | LOG.Info("Started TCP server on port " + boost::lexical_cast<std::string>(port) + "."); |
39 | LOG.Info("Started TCP server on port " + boost::lexical_cast<std::string>(port) + "."); |
| 40 | LOG.Debug("Server id is " + boost::lexical_cast<std::string>(this->server_id_) + "."); |
40 | LOG.Debug("Server id is " + boost::lexical_cast<std::string>(this->server_id_) + "."); |
| 41 | } |
41 | } |
| 42 | catch (std::runtime_error& e) |
42 | catch (std::runtime_error& e) |
| 43 | { |
43 | { |
| 44 | LOG.Error(e.what()); |
44 | LOG.Error(e.what()); |
| 45 | } |
45 | } |
| 46 | } |
46 | } |
| 47 | 47 | ||
| 48 | CanDaemon::~CanDaemon() |
48 | CanDaemon::~CanDaemon() |
| 49 | { |
49 | { |
| 50 | net::Manager::Instance()->StopServer(this->server_id_); |
50 | net::Manager::Instance()->StopServer(this->server_id_); |
| 51 | this->server_id_ = 0; |
51 | this->server_id_ = 0; |
| 52 | } |
52 | } |
| 53 | 53 | ||
| 54 | 54 | ||
| 55 | void CanDaemon::SlotOnMessageHandler(broker::Message::Pointer message) |
55 | void CanDaemon::SlotOnMessageHandler(broker::Message::Pointer message) |
| 56 | { |
56 | { |
| 57 | if (message->GetType() == broker::Message::CAN_RAW_MESSAGE) |
57 | if (message->GetType() == broker::Message::CAN_RAW_MESSAGE) |
| 58 | { |
58 | { |
| 59 | std::string* payload_str; |
59 | std::string* payload_str; |
| 60 | 60 | ||
| 61 | payload_str = static_cast<std::string*>(message->GetPayload().get()); |
61 | payload_str = static_cast<std::string*>(message->GetPayload().get()); |
| 62 | std::string line = *payload_str; |
62 | std::string line = *payload_str; |
| 63 | 63 | ||
| 64 | net::Manager::Instance()->SendToAll(this->server_id_, common::Byteset(line, true)); |
64 | net::Manager::Instance()->SendToAll(this->server_id_, common::Byteset(line, true)); |
| 65 | } |
65 | } |
| 66 | } |
66 | } |
| 67 | 67 | ||
| 68 | void CanDaemon::SlotOnNewDataHandler(net::SocketId |
68 | void CanDaemon::SlotOnNewDataHandler(net::SocketId id, common::Byteset data) |
| 69 | { |
69 | { |
| 70 | if ( |
70 | if (std::find(this->clients_.begin(), this->clients_.end(), id) == this->clients_.end()) |
| 71 | { |
71 | { |
| 72 | return; |
72 | return; |
| 73 | } |
73 | } |
| 74 | 74 | ||
| 75 | std::string str = data.ToCharString(); |
75 | std::string str = data.ToCharString(); |
| 76 | 76 | ||
| 77 | boost::algorithm::trim_right_if(str, boost::is_any_of("\r\n")); |
77 | boost::algorithm::trim_right_if(str, boost::is_any_of("\r\n")); |
| 78 | 78 | ||
| 79 |
|
79 | LOG.Info("Received: \"" + str + "\" from client " + boost::lexical_cast<std::string>(id) + " on server " + boost::lexical_cast<std::string>(this->server_id_)); |
| 80 | 80 | ||
| 81 | std::string* payload_str = new std::string(str); |
81 | std::string* payload_str = new std::string(str); |
| 82 | broker::Manager::Instance()->Post(broker::Message::Pointer(new broker::Message(broker::Message::CAN_RAW_MESSAGE, broker::Message::PayloadPointer(payload_str), this))); |
82 | broker::Manager::Instance()->Post(broker::Message::Pointer(new broker::Message(broker::Message::CAN_RAW_MESSAGE, broker::Message::PayloadPointer(payload_str), this))); |
| 83 | 83 | ||
| 84 | //LOG.Info("Sent..."); |
84 | //LOG.Info("Sent..."); |
| 85 | 85 | ||
| 86 | if (str == "q" || str == "quit") |
86 | if (str == "q" || str == "quit") |
| 87 | { |
87 | { |
| 88 | LOG.Info("Client " + boost::lexical_cast<std::string>( |
88 | LOG.Info("Client " + boost::lexical_cast<std::string>(id) + " has requested to be disconnected."); |
| 89 | net::Manager::Instance()->Disconnect( |
89 | net::Manager::Instance()->Disconnect(id); |
| 90 | } |
90 | } |
| 91 | } |
91 | } |
| 92 | 92 | ||
| 93 | void CanDaemon:: |
93 | void CanDaemon::SlotOnNewClientHandler(net::SocketId id, net::SocketId server_id) |
| 94 | { |
94 | { |
| 95 |
|
95 | if (server_id == this->server_id_) |
| - | 96 | { |
|
| - | 97 | this->clients_.insert(id); |
|
| - | 98 | } |
|
| - | 99 | } |
|
| - | 100 | ||
| - | 101 | void CanDaemon::SlotOnNewStateHandler(net::SocketId id, net::ClientState client_state) |
|
| - | 102 | { |
|
| - | 103 | if (std::find(this->clients_.begin(), this->clients_.end(), id) == this->clients_.end()) |
|
| 96 | { |
104 | { |
| 97 | return; |
105 | return; |
| 98 | } |
106 | } |
| 99 | 107 | ||
| 100 | if (client_state == net::CLIENT_STATE_DISCONNECTED) |
108 | if (client_state == net::CLIENT_STATE_DISCONNECTED) |
| 101 | { |
109 | { |
| 102 | LOG.Info("Client " + boost::lexical_cast<std::string>( |
110 | LOG.Info("Client " + boost::lexical_cast<std::string>(id) + " has disconnected."); |
| - | 111 | this->clients_.erase(id); |
|
| 103 | } |
112 | } |
| 104 | else if (client_state == net::CLIENT_STATE_CONNECTED) |
113 | else if (client_state == net::CLIENT_STATE_CONNECTED) |
| 105 | { |
114 | { |
| 106 | LOG.Info("Client " + boost::lexical_cast<std::string>( |
115 | LOG.Info("Client " + boost::lexical_cast<std::string>(id) + " has connected."); |
| 107 | } |
116 | } |
| 108 | else |
117 | else |
| 109 | { |
118 | { |
| 110 | LOG.Debug("Got state: " + boost::lexical_cast<std::string>((int)client_state)); |
119 | LOG.Debug("Got state: " + boost::lexical_cast<std::string>((int)client_state)); |
| 111 | } |
120 | } |
| 112 | } |
121 | } |
| 113 | 122 | ||
| 114 | }; // namespace can |
123 | }; // namespace can |
| 115 | }; // namespace atom |
124 | }; // namespace atom |
| 116 | 125 | ||