Subversion Repositories HomeAutomation

Rev

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
      //line 
62
   
63
        net::Manager::Instance()->SendToAll(this->server_id_, common::Byteset(line));
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