Rev 1914 | Rev 1918 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed
| Rev 1914 | Rev 1916 | ||
|---|---|---|---|
| 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 | 27 | ||
| 28 | #include "Message.h" |
28 | #include "Message.h" |
| 29 | 29 | ||
| 30 | namespace atom { |
30 | namespace atom { |
| 31 | namespace can { |
31 | namespace can { |
| 32 | 32 | ||
| 33 | CanDaemon::CanDaemon(unsigned int port): broker::Subscriber(port), LOG("can::CanDaemon") |
33 | CanDaemon::CanDaemon(unsigned int port): broker::Subscriber(port), LOG("can::CanDaemon") |
| 34 | { |
34 | { |
| 35 | try |
35 | try |
| 36 | { |
36 | { |
| 37 | this->server_id_ = net::Manager::Instance()->StartServer(net::PROTOCOL_TCP, port); |
37 | this->server_id_ = net::Manager::Instance()->StartServer(net::PROTOCOL_TCP, port); |
| 38 | LOG.Info("Started TCP server on port " + boost::lexical_cast<std::string>(port) + "."); |
38 | LOG.Info("Started TCP server on port " + boost::lexical_cast<std::string>(port) + "."); |
| 39 | LOG.Debug("Server id is " + boost::lexical_cast<std::string>(this->server_id_) + "."); |
39 | LOG.Debug("Server id is " + boost::lexical_cast<std::string>(this->server_id_) + "."); |
| 40 | } |
40 | } |
| 41 | catch (std::runtime_error& e) |
41 | catch (std::runtime_error& e) |
| 42 | { |
42 | { |
| 43 | LOG.Error(e.what()); |
43 | LOG.Error(e.what()); |
| 44 | } |
44 | } |
| 45 | } |
45 | } |
| 46 | 46 | ||
| 47 | CanDaemon::~CanDaemon() |
47 | CanDaemon::~CanDaemon() |
| 48 | { |
48 | { |
| 49 | net::Manager::Instance()->StopServer(this->server_id_); |
49 | net::Manager::Instance()->StopServer(this->server_id_); |
| 50 | this->server_id_ = 0; |
50 | this->server_id_ = 0; |
| 51 | } |
51 | } |
| 52 | 52 | ||
| 53 | 53 | ||
| 54 | void CanDaemon::SlotOnMessageHandler(broker::Message::Pointer message) |
54 | void CanDaemon::SlotOnMessageHandler(broker::Message::Pointer message) |
| 55 | { |
55 | { |
| 56 | if (message->GetType() == broker::Message::CAN_RAW_MESSAGE) |
56 | if (message->GetType() == broker::Message::CAN_RAW_MESSAGE) |
| 57 | { |
57 | { |
| 58 | std::string* payload_str; |
58 | std::string* payload_str; |
| - | 59 | ||
| 59 | payload_str = static_cast<std::string*>(message->GetPayload().get()); |
60 | payload_str = static_cast<std::string*>(message->GetPayload().get()); |
| 60 | std::string line = *payload_str; |
61 | std::string line = *payload_str; |
| 61 | //std::string line2 = line.substr(0, 15)+"\n"; //line += *payload_str; |
- | |
| 62 |
|
62 | |
| 63 | net::Manager::Instance()->SendToAll(this->server_id_, common::Byteset( |
63 | net::Manager::Instance()->SendToAll(this->server_id_, common::Byteset(line, true)); |
| 64 | } |
64 | } |
| 65 | } |
65 | } |
| 66 | 66 | ||
| 67 | 67 | ||
| 68 | void CanDaemon::SlotOnNewDataHandler(net::ClientId client_id, net::ServerId server_id, common::Byteset data) |
68 | void CanDaemon::SlotOnNewDataHandler(net::ClientId client_id, net::ServerId server_id, common::Byteset data) |
| 69 | { |
69 | { |
| 70 | if (server_id != this->server_id_) |
70 | if (server_id != this->server_id_) |
| 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 | LOG.Debug("Received: \"" + str + "\" from client " + boost::lexical_cast<std::string>(client_id) + " on server " + boost::lexical_cast<std::string>(server_id)); |
79 | LOG.Debug("Received: \"" + str + "\" from client " + boost::lexical_cast<std::string>(client_id) + " on server " + boost::lexical_cast<std::string>(server_id)); |
| 80 | 80 | ||
| 81 | if (str == "q" || str == "quit") |
81 | if (str == "q" || str == "quit") |
| 82 | { |
82 | { |
| 83 | LOG.Info("Client " + boost::lexical_cast<std::string>(client_id) + " has requested to be disconnected."); |
83 | LOG.Info("Client " + boost::lexical_cast<std::string>(client_id) + " has requested to be disconnected."); |
| 84 | net::Manager::Instance()->Disconnect(client_id); |
84 | net::Manager::Instance()->Disconnect(client_id); |
| 85 | } |
85 | } |
| 86 | } |
86 | } |
| 87 | 87 | ||
| 88 | void CanDaemon::SlotOnNewStateHandler(net::ClientId client_id, net::ServerId server_id, net::ClientState client_state) |
88 | void CanDaemon::SlotOnNewStateHandler(net::ClientId client_id, net::ServerId server_id, net::ClientState client_state) |
| 89 | { |
89 | { |
| 90 | if (server_id != this->server_id_) |
90 | if (server_id != this->server_id_) |
| 91 | { |
91 | { |
| 92 | return; |
92 | return; |
| 93 | } |
93 | } |
| 94 | 94 | ||
| 95 | if (client_state == net::CLIENT_STATE_DISCONNECTED) |
95 | if (client_state == net::CLIENT_STATE_DISCONNECTED) |
| 96 | { |
96 | { |
| 97 | LOG.Info("Client " + boost::lexical_cast<std::string>(client_id) + " has disconnected."); |
97 | LOG.Info("Client " + boost::lexical_cast<std::string>(client_id) + " has disconnected."); |
| 98 | } |
98 | } |
| 99 | else if (client_state == net::CLIENT_STATE_CONNECTED) |
99 | else if (client_state == net::CLIENT_STATE_CONNECTED) |
| 100 | { |
100 | { |
| 101 | LOG.Info("Client " + boost::lexical_cast<std::string>(client_id) + " has connected."); |
101 | LOG.Info("Client " + boost::lexical_cast<std::string>(client_id) + " has connected."); |
| 102 | net::Manager::Instance()->SendTo(client_id, common::Byteset("Welcome to Atom canDaemon emulator\n")); |
- | |
| 103 | } |
102 | } |
| 104 | else |
103 | else |
| 105 | { |
104 | { |
| 106 | LOG.Debug("Got state: " + boost::lexical_cast<std::string>((int)client_state)); |
105 | LOG.Debug("Got state: " + boost::lexical_cast<std::string>((int)client_state)); |
| 107 | } |
106 | } |
| 108 | } |
107 | } |
| 109 | 108 | ||
| 110 | }; // namespace can |
109 | }; // namespace can |
| 111 | }; // namespace atom |
110 | }; // namespace atom |
| 112 | 111 | ||