1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
|
/*
Copyright (C) 2012 Intel Corporation
This library is free software; you can redistribute it and/or
modify it under the terms of the GNU Lesser General Public
License as published by the Free Software Foundation; either
version 2.1 of the License, or (at your option) any later version.
This library is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
Lesser General Public License for more details.
You should have received a copy of the GNU Lesser General Public
License along with this library; if not, write to the Free Software
Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
*/
#include "demosinkplugin.h"
#include "abstractroutingengine.h"
#include <iostream>
#include <stdexcept>
#include <boost/assert.hpp>
#include <glib.h>
using namespace std;
#include "debugout.h"
string findReplace(string str, string tofind, string replacewith, string exclusions="")
{
size_t i=0;
size_t exclusionPos = exclusions.find(tofind,0);
while((i = str.find(tofind,i)) != string::npos)
{
if( exclusionPos != string::npos )
{
if(str.substr(i-exclusionPos,exclusions.length()) == exclusions)
{
i+=replacewith.size();
continue;
}
}
str.replace(i,tofind.size(),replacewith);
i+=replacewith.size();
}
return str;
}
DemoSink::DemoSink(AbstractRoutingEngine* re, map<string, string> config)
:AbstractSink(re, config)
{
routingEngine->subscribeToProperty(VehicleProperty::ButtonEvent, this);
routingEngine->subscribeToProperty(VehicleProperty::TurnSignal, this);
routingEngine->subscribeToProperty(VehicleProperty::MachineGunTurretStatus, this);
}
DemoSink::~DemoSink()
{
}
extern "C" void create(AbstractRoutingEngine* routingEngine, map<string, string> config)
{
new DemoSink(routingEngine, config);
}
const string DemoSink::uuid()
{
return "5b0e8a04-d6d7-43af-b827-1663627a25d9";
}
void DemoSink::propertyChanged(AbstractPropertyType *value)
{
VehicleProperty::Property property = value->name;
std::string app = configuration["script"];
std::string strValue = value->toString();
if(property == VehicleProperty::TurnSignal)
{
if(value->value<TurnSignals::TurnSignalType>() == TurnSignals::Right)
{
strValue = "Right";
}
else if(value->value<TurnSignals::TurnSignalType>() == TurnSignals::Left)
{
strValue = "Left";
}
else if(value->value<TurnSignals::TurnSignalType>() == TurnSignals::Off)
{
strValue = "Off";
}
} else if (property == VehicleProperty::ButtonEvent) {
if (value->value<ButtonEvents::ButtonEventType>() == ButtonEvents::Preset1Button)
strValue = "Button1";
else if (value->value<ButtonEvents::ButtonEventType>() == ButtonEvents::Preset2Button)
strValue = "Button2";
else if (value->value<ButtonEvents::ButtonEventType>() == ButtonEvents::Preset3Button)
strValue = "Button3";
else if (value->value<ButtonEvents::ButtonEventType>() == ButtonEvents::Preset4Button)
strValue = "Button4";
}
string cmdline = findReplace(app,"%1",strValue);
GError* error = NULL;
if(!g_spawn_command_line_async(cmdline.c_str(), &error))
DebugOut()<<"Failed to launch command: "<<cmdline<<endl;
}
void DemoSink::supportedChanged(const PropertyList & list)
{
routingEngine->subscribeToProperty(VehicleProperty::ButtonEvent, this);
routingEngine->subscribeToProperty(VehicleProperty::TurnSignal, this);
}
|