Subversion Repositories HomeAutomation

Rev

Rev 1633 | Rev 1644 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed

Rev 1633 Rev 1642
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 "Manager.h"
21
#include "Manager.h"
22
 
22
 
23
#include <boost/lexical_cast.hpp>
23
#include <boost/lexical_cast.hpp>
24
 
24
 
25
#include "broker/Manager.h"
25
#include "broker/Manager.h"
26
#include "broker/Message.h"
26
#include "broker/Message.h"
27
#include "type/common.h"
27
#include "common/common.h"
28
#include "timer/Manager.h"
28
#include "timer/Manager.h"
29
#include "storage/Manager.h"
29
#include "storage/Manager.h"
30
 
30
 
31
#include "Message.h"
31
#include "can/Message.h"
32
 
32
 
33
namespace atom {
33
namespace atom {
34
namespace can {
34
namespace control {
35
   
35
   
36
Manager::Pointer Manager::instance_;
36
Manager::Pointer Manager::instance_;
37
 
37
 
38
Manager::Manager() : broker::Subscriber(false), LOG("can::Manager")
38
Manager::Manager() : broker::Subscriber(false), LOG("control::Manager")
39
{
39
{
40
    Node::SetupStateMachine();
40
    Node::SetupStateMachine();
41
   
41
   
42
    this->active_programming_node_id_ = 0;
42
    this->active_programming_node_id_ = 0;
43
   
43
   
44
    // Nyquist–Shannon sampling theorem state that we need to double the time, modules send every 10 seconds
44
    // Nyquist–Shannon sampling theorem state that we need to double the time, modules send every 10 seconds
45
    this->timer_id_ = timer::Manager::Instance()->Set(20000, true);
45
    this->timer_id_ = timer::Manager::Instance()->Set(20000, true);
46
}
46
}
47
 
47
 
48
Manager::~Manager()
48
Manager::~Manager()
49
{
49
{
50
}
50
}
51
 
51
 
52
Manager::Pointer Manager::Instance()
52
Manager::Pointer Manager::Instance()
53
{
53
{
54
    return Manager::instance_;
54
    return Manager::instance_;
55
}
55
}
56
 
56
 
57
void Manager::Create()
57
void Manager::Create()
58
{
58
{
59
    Manager::instance_ = Manager::Pointer(new Manager());
59
    Manager::instance_ = Manager::Pointer(new Manager());
60
}
60
}
61
 
61
 
62
void Manager::Delete()
62
void Manager::Delete()
63
{
63
{
64
    Manager::instance_.reset();
64
    Manager::instance_.reset();
65
}
65
}
66
 
66
 
67
void Manager::ConnectSlots(const SignalOnNodeChange::slot_type& signal_on_node_change_, const SignalOnModuleChange::slot_type& slot_on_module_change, const SignalOnModuleMessage::slot_type& slot_on_module_message)
67
void Manager::ConnectSlots(const SignalOnNodeChange::slot_type& signal_on_node_change_, const SignalOnModuleChange::slot_type& slot_on_module_change, const SignalOnModuleMessage::slot_type& slot_on_module_message)
68
{
68
{
69
    this->signal_on_node_change_.connect(signal_on_node_change_);
69
    this->signal_on_node_change_.connect(signal_on_node_change_);
70
    this->signal_on_module_change_.connect(slot_on_module_change);
70
    this->signal_on_module_change_.connect(slot_on_module_change);
71
    this->signal_on_module_message_.connect(slot_on_module_message);
71
    this->signal_on_module_message_.connect(slot_on_module_message);
72
}
72
}
73
 
73
 
74
void Manager::SlotOnTimeoutHandler(timer::TimerId timer_id, bool repeat)
74
void Manager::SlotOnTimeoutHandler(timer::TimerId timer_id, bool repeat)
75
{
75
{
76
    if (timer_id != this->timer_id_)
76
    if (timer_id != this->timer_id_)
77
    {
77
    {
78
        return;
78
        return;
79
    }
79
    }
80
   
80
   
81
    for (NodeList::iterator it = this->nodes_.begin(); it != this->nodes_.end(); it++)
81
    for (NodeList::iterator it = this->nodes_.begin(); it != this->nodes_.end(); it++)
82
    {
82
    {
83
        if (!it->second->CheckTimeout())
83
        if (!it->second->CheckTimeout())
84
        {
84
        {
85
            LOG.Info("Node " + type::ToHex(it->second->GetId()) + " has not sent anything in a long time, setting offline.");
85
            LOG.Info("Node " + common::ToHex(it->second->GetId()) + " has not sent anything in a long time, setting offline.");
86
            this->RemoveModules(it->second->GetId());
86
            this->RemoveModules(it->second->GetId());
87
           
87
           
88
            storage::Manager::Instance()->FlushStore("NodeList");
88
            storage::Manager::Instance()->FlushStore("NodeList");
89
            storage::Manager::Instance()->FlushStore("ModuleList");
89
            storage::Manager::Instance()->FlushStore("ModuleList");
90
        }
90
        }
91
    }
91
    }
92
}
92
}
93
 
93
 
94
void Manager::SlotOnMessageHandler(broker::Message::Pointer message)
94
void Manager::SlotOnMessageHandler(broker::Message::Pointer message)
95
{
95
{
96
    if (message->GetType() == broker::Message::CAN_MESSAGE)
96
    if (message->GetType() == broker::Message::CAN_MESSAGE)
97
    {
97
    {
98
        //LOG.Debug("Message received");
98
        //LOG.Debug("Message received");
99
        Message* payload = static_cast<Message*>(message->GetPayload().get());
99
        can::Message* payload = static_cast<can::Message*>(message->GetPayload().get());
100
        Node::Pointer node;
100
        Node::Pointer node;
101
       
101
       
102
        if (payload->GetClassName() == "nmt")
102
        if (payload->GetClassName() == "nmt")
103
        {
103
        {
104
            if (payload->GetCommandName() == "Bios_Start")
104
            if (payload->GetCommandName() == "Bios_Start")
105
            {
105
            {
106
                node = this->GetNode(boost::lexical_cast<unsigned int>(payload->GetVariables()["HardwareId"]));
106
                node = this->GetNode(boost::lexical_cast<unsigned int>(payload->GetVariables()["HardwareId"]));
107
                node->Trigger(Node::EVENT_BIOS_START, payload->GetVariables());
107
                node->Trigger(Node::EVENT_BIOS_START, payload->GetVariables());
108
            }
108
            }
109
            else if (payload->GetCommandName() == "App_Start")
109
            else if (payload->GetCommandName() == "App_Start")
110
            {
110
            {
111
                node = this->GetNode(boost::lexical_cast<unsigned int>(payload->GetVariables()["HardwareId"]));
111
                node = this->GetNode(boost::lexical_cast<unsigned int>(payload->GetVariables()["HardwareId"]));
112
                node->Trigger(Node::EVENT_APP_START, payload->GetVariables());
112
                node->Trigger(Node::EVENT_APP_START, payload->GetVariables());
113
            }
113
            }
114
            else if (payload->GetCommandName() == "Heartbeat")
114
            else if (payload->GetCommandName() == "Heartbeat")
115
            {
115
            {
116
                node = this->GetNode(boost::lexical_cast<unsigned int>(payload->GetVariables()["HardwareId"]));
116
                node = this->GetNode(boost::lexical_cast<unsigned int>(payload->GetVariables()["HardwareId"]));
117
                node->Trigger(Node::EVENT_HEARTBEAT, payload->GetVariables());
117
                node->Trigger(Node::EVENT_HEARTBEAT, payload->GetVariables());
-
 
118
            }
-
 
119
            else if (payload->GetCommandName() == "Pgm_Ack")
-
 
120
            {
-
 
121
                node = this->GetNode(this->active_programming_node_id_);
-
 
122
                node->Trigger(Node::EVENT_PGM_ACK, payload->GetVariables());
-
 
123
            }
-
 
124
            else if (payload->GetCommandName() == "Pgm_Nack")
-
 
125
            {
-
 
126
                node = this->GetNode(this->active_programming_node_id_);
-
 
127
                node->Trigger(Node::EVENT_PGM_NACK, payload->GetVariables());
118
            }
128
            }
119
        }
129
        }
120
        else if (payload->GetDirectionName() == "From_Owner")
130
        else if (payload->GetDirectionName() == "From_Owner")
121
        {
131
        {
122
            Module::Pointer module = this->GetModule(boost::lexical_cast<unsigned int>(payload->GetId()), payload->GetModuleName(), payload->GetClassName());
132
            Module::Pointer module = this->GetModule(boost::lexical_cast<unsigned int>(payload->GetId()), payload->GetModuleName(), payload->GetClassName());
123
           
133
           
124
            if (payload->GetCommandName() == "List")
134
            if (payload->GetCommandName() == "List")
125
            {
135
            {
126
                node = this->GetNode(boost::lexical_cast<unsigned int>(payload->GetVariables()["HardwareId"]));
136
                node = this->GetNode(boost::lexical_cast<unsigned int>(payload->GetVariables()["HardwareId"]));
127
                node->ResetTimeout();
137
                node->ResetTimeout();
128
               
138
               
129
                module->SetNodeId(node->GetId());
139
                module->SetNodeId(node->GetId());
130
               
140
               
131
                if (this->GetNumberOfModules(node->GetId()) == boost::lexical_cast<unsigned int>(payload->GetVariables()["NumberOfModules"]))
141
                if (this->GetNumberOfModules(node->GetId()) == boost::lexical_cast<unsigned int>(payload->GetVariables()["NumberOfModules"]))
132
                {
142
                {
133
                    node->Trigger(Node::EVENT_LIST_DONE, payload->GetVariables());
143
                    node->Trigger(Node::EVENT_LIST_DONE, payload->GetVariables());
134
                }
144
                }
135
               
145
               
136
                LOG.Info("Module " + module->GetFullId() + " is available on node " + type::ToHex(node->GetId()) + ".");
146
                LOG.Info("Module " + module->GetFullId() + " is available on node " + common::ToHex(node->GetId()) + ".");
137
                this->signal_on_module_change_(module->GetFullId(), true);
147
                this->signal_on_module_change_(module->GetFullId(), true);
138
            }
148
            }
139
            else
149
            else
140
            {
150
            {
141
                node = this->GetNode(module->GetNodeId());
151
                node = this->GetNode(module->GetNodeId());
142
                node->ResetTimeout();
152
                node->ResetTimeout();
143
               
153
               
144
                this->signal_on_module_message_(module->GetFullId(), payload->GetCommandName(), payload->GetVariables());
154
                this->signal_on_module_message_(module->GetFullId(), payload->GetCommandName(), payload->GetVariables());
145
            }
155
            }
146
        }
156
        }
147
    }
157
    }
148
}
158
}
149
 
159
 
150
void Manager::SlotOnNewState(Node::Id node_id, Node::State current_state, Node::State target_state)
160
void Manager::SlotOnNewState(Node::Id node_id, Node::State current_state, Node::State target_state)
151
{
161
{
152
    if (target_state != Node::STATE_NORM_INITIALIZED)
162
    if (target_state != Node::STATE_NORM_INITIALIZED)
153
    {
163
    {
154
        this->RemoveModules(node_id);
164
        this->RemoveModules(node_id);
155
    }
165
    }
156
   
166
   
157
    if (target_state == Node::STATE_BPGM_OFFLINE || target_state == Node::STATE_APGM_OFFLINE)
167
    if (target_state == Node::STATE_BPGM_OFFLINE || target_state == Node::STATE_APGM_OFFLINE)
158
    {
168
    {
159
        this->active_programming_node_id_ = node_id;
169
        this->active_programming_node_id_ = node_id;
160
    }
170
    }
161
    else if (target_state == Node::STATE_NORM_OFFLINE)
171
    else if (target_state == Node::STATE_NORM_OFFLINE)
162
    {
172
    {
163
        this->active_programming_node_id_ = 0;
173
        this->active_programming_node_id_ = 0;
164
    }
174
    }
165
}
175
}
166
 
176
 
167
void Manager::SendMessageHandler(std::string full_id, std::string command, type::StringMap variables)
177
void Manager::SendMessageHandler(std::string full_id, std::string command, common::StringMap variables)
168
{
178
{
169
    ModuleList::iterator it = this->modules_.find(full_id);
179
    ModuleList::iterator it = this->modules_.find(full_id);
170
   
180
   
171
    if (it == this->modules_.end())
181
    if (it == this->modules_.end())
172
    {
182
    {
173
        LOG.Warning("Can not send message to " + full_id + ", it is not available");
183
        LOG.Warning("Can not send message to " + full_id + ", it is not available");
174
        return;
184
        return;
175
    }
185
    }
176
   
186
   
177
    try
187
    try
178
    {
188
    {
179
        Message* payload = new Message(it->second->GetClassName(), "To_Owner", it->second->GetName(), it->second->GetId(), command);
189
        can::Message* payload = new can::Message(it->second->GetClassName(), "To_Owner", it->second->GetName(), it->second->GetId(), command);
180
        payload->SetVariables(variables);
190
        payload->SetVariables(variables);
181
       
191
       
182
        broker::Manager::Instance()->Post(broker::Message::Pointer(new broker::Message(broker::Message::CAN_MESSAGE, broker::Message::PayloadPointer(payload), this)));
192
        broker::Manager::Instance()->Post(broker::Message::Pointer(new broker::Message(broker::Message::CAN_MESSAGE, broker::Message::PayloadPointer(payload), this)));
183
        //LOG.Debug("Command " + command + " sent to " + it->second->GetName());
193
        //LOG.Debug("Command " + command + " sent to " + it->second->GetName());
184
    }
194
    }
185
    catch (std::runtime_error& e)
195
    catch (std::runtime_error& e)
186
    {
196
    {
187
        LOG.Error("Failed to send message, " + std::string(e.what()));
197
        LOG.Error("Failed to send message, " + std::string(e.what()));
188
    }
198
    }
189
}
199
}
190
 
200
 
191
void Manager::SendMessage(std::string full_id, std::string command, type::StringMap variables)
201
void Manager::SendMessage(std::string full_id, std::string command, common::StringMap variables)
192
{
202
{
193
    this->io_service_.post(boost::bind(&Manager::SendMessageHandler, this, full_id, command, variables));
203
    this->io_service_.post(boost::bind(&Manager::SendMessageHandler, this, full_id, command, variables));
194
}
204
}
195
 
205
 
196
bool Manager::IsModuleAvailable(std::string full_id)
206
bool Manager::IsModuleAvailable(std::string full_id)
197
{
207
{
198
    return this->modules_.find(full_id) != this->modules_.end();
208
    return this->modules_.find(full_id) != this->modules_.end();
-
 
209
}
-
 
210
 
-
 
211
bool Manager::ProgramNode(Node::Id node_id, bool is_bios, std::string filename)
-
 
212
{
-
 
213
    NodeList::iterator it = this->nodes_.find(node_id);
-
 
214
   
-
 
215
    if (it == this->nodes_.end())
-
 
216
    {
-
 
217
        LOG.Error("Could not find node " +  common::ToHex(node_id));
-
 
218
        return false;
-
 
219
    }
-
 
220
   
-
 
221
    Code::Pointer code = Code::Pointer(new Code());
-
 
222
    if (!code->LoadIntelHexFile(filename))
-
 
223
    {
-
 
224
        LOG.Error("Failed to parse " + filename);
-
 
225
        return false;
-
 
226
    }
-
 
227
   
-
 
228
    if (is_bios)
-
 
229
    {
-
 
230
        LOG.Debug("is_bios true");
-
 
231
        it->second->ProgramBios(code);
-
 
232
    }
-
 
233
    else
-
 
234
    {
-
 
235
        LOG.Debug("is_bios false");
-
 
236
        it->second->ProgramApplication(code);
-
 
237
    }
-
 
238
   
-
 
239
    return true;
199
}
240
}
200
 
241
 
201
Node::Pointer Manager::GetNode(Node::Id node_id)
242
Node::Pointer Manager::GetNode(Node::Id node_id)
202
{
243
{
203
    Node::Pointer node;
244
    Node::Pointer node;
204
    NodeList::iterator it = this->nodes_.find(node_id);
245
    NodeList::iterator it = this->nodes_.find(node_id);
205
   
246
   
206
    if (it == this->nodes_.end())
247
    if (it == this->nodes_.end())
207
    {
248
    {
208
        node = Node::Pointer(new Node(node_id));
249
        node = Node::Pointer(new Node(node_id));
209
        node->ConnectSlots(Node::SignalOnNewState::slot_type(&Manager::SlotOnNewState, this, _1, _2, _3).track(this->tracker_));
250
        node->ConnectSlots(Node::SignalOnNewState::slot_type(&Manager::SlotOnNewState, this, _1, _2, _3).track(this->tracker_));
210
        this->nodes_[node_id] = node;
251
        this->nodes_[node_id] = node;
211
    }
252
    }
212
    else
253
    else
213
    {
254
    {
214
        node = it->second;
255
        node = it->second;
215
    }
256
    }
216
   
257
   
217
    return node;
258
    return node;
218
}
259
}
219
 
260
 
220
Module::Pointer Manager::GetModule(Module::Id module_id, std::string module_name, std::string class_name)
261
Module::Pointer Manager::GetModule(Module::Id module_id, std::string module_name, std::string class_name)
221
{
262
{
222
    Module::Pointer module;
263
    Module::Pointer module;
223
    ModuleList::iterator it = this->modules_.find(Module::MakeFullId(module_id, module_name));
264
    ModuleList::iterator it = this->modules_.find(Module::MakeFullId(module_id, module_name));
224
   
265
   
225
    if (it == this->modules_.end())
266
    if (it == this->modules_.end())
226
    {
267
    {
227
        module = Module::Pointer(new Module(module_id, module_name, class_name));
268
        module = Module::Pointer(new Module(module_id, module_name, class_name));
228
        this->modules_[module->GetFullId()] = module;
269
        this->modules_[module->GetFullId()] = module;
229
    }
270
    }
230
    else
271
    else
231
    {
272
    {
232
        module = it->second;
273
        module = it->second;
233
    }
274
    }
234
   
275
   
235
    return module;
276
    return module;
236
}
277
}
237
 
278
 
238
void Manager::RemoveModules(Node::Id node_id)
279
void Manager::RemoveModules(Node::Id node_id)
239
{
280
{
240
    for (ModuleList::iterator it = this->modules_.begin(); it != this->modules_.end(); it++)
281
    for (ModuleList::iterator it = this->modules_.begin(); it != this->modules_.end(); it++)
241
    {
282
    {
242
        if (it->second->GetNodeId() == node_id)
283
        if (it->second->GetNodeId() == node_id)
243
        {
284
        {
244
            LOG.Info("Module " + it->second->GetFullId() + " is unavailable.");
285
            LOG.Info("Module " + it->second->GetFullId() + " is unavailable.");
245
            this->signal_on_module_change_(it->second->GetFullId(), false);
286
            this->signal_on_module_change_(it->second->GetFullId(), false);
246
           
287
           
247
            this->modules_.erase(it);
288
            this->modules_.erase(it);
248
        }
289
        }
249
    }
290
    }
250
}
291
}
251
 
292
 
252
unsigned int Manager::GetNumberOfModules(Node::Id node_id)
293
unsigned int Manager::GetNumberOfModules(Node::Id node_id)
253
{
294
{
254
    unsigned int number_of_modules = 0;
295
    unsigned int number_of_modules = 0;
255
   
296
   
256
    for (ModuleList::iterator it = this->modules_.begin(); it != this->modules_.end(); it++)
297
    for (ModuleList::iterator it = this->modules_.begin(); it != this->modules_.end(); it++)
257
    {
298
    {
258
        if (it->second->GetNodeId() == node_id)
299
        if (it->second->GetNodeId() == node_id)
259
        {
300
        {
260
            number_of_modules++;
301
            number_of_modules++;
261
        }
302
        }
262
    }
303
    }
263
   
304
   
264
    return number_of_modules;
305
    return number_of_modules;
265
}
306
}
266
 
307
 
267
 
-
 
268
}; // namespace can
308
}; // namespace control
269
}; // namespace atom
309
}; // namespace atom
270
 
310