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
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
|
/*
* Copyright (C) 2015 by Multi-Tech Systems
*
* This file is part of libmts-io.
*
* libmts-io 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 of the License, or
* (at your option) any later version.
*
* libmts-io 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 libmts-io. If not, see <http://www.gnu.org/licenses/>.
*
*/
/*!
\file MTS_IO_LE910Radio.cpp
\brief A brief description
\date Nov 6, 2014
\author sgodinez
A more elaborate description
*/
#include <mts/MTS_IO_LE910Radio.h>
#include <mts/MTS_Logger.h>
#include <mts/MTS_Text.h>
using namespace MTS::IO;
LE910Radio::LE910Radio(const std::string& sLE910Model, const std::string& sPort)
: TelitRadio(sLE910Model, sPort)
{
}
ICellularRadio::CODE LE910Radio::setRxDiversity(const Json::Value& jArgs) {
/* Command string for LAT1,LVW2,LEU1 radios: "AT#RXDIV=" */
/* Setting needs to append ",1" to the 0/1 value */
if (jArgs["enabled"].asString() != "1" && jArgs["enabled"].asString() != "0")
{
return FAILURE;
}
std::string sCmd = "AT#RXDIV=";
sCmd += jArgs["enabled"].asString();
sCmd += ",1";
return sendBasicCommand(sCmd);
}
ICellularRadio::CODE LE910Radio::getModemLocation(std::string& sLocation) {
const std::string& whitespace = " \t";
printTrace("LE910Radio getModemLocation");
std::string sCmd("AT$GPSACP");
std::string sResult = sendCommand(sCmd);
if (sResult.find("$GPSACP: ") == std::string::npos) {
printDebug("AT$GPSACP command returned unexpected response: [%s]", sResult.c_str());
return FAILURE;
}
printDebug("modem reply: [%s]", sResult.c_str());
size_t start = sResult.find(':');
if (start==std::string::npos){
start = 0;
} else {
start++;
}
start = sResult.find_first_not_of(whitespace, start);
size_t stop = sResult.find('\n', start);
sLocation = sResult.substr(start, stop - start - 1);
printDebug("function reply: [%s]", sLocation.c_str());
return SUCCESS;
}
ICellularRadio::CODE LE910Radio::setUeModeOfOperation(ICellularRadio::UE_MODES_OF_OPERATION mode) {
printTrace("%s| Set UE Mode Of Operation", getName().c_str());
std::string sValue;
switch (mode) {
case ICellularRadio::UE_MODES_OF_OPERATION::PS_MODE1:
sValue = "3";
break;
case ICellularRadio::UE_MODES_OF_OPERATION::PS_MODE2:
sValue = "0";
break;
case ICellularRadio::UE_MODES_OF_OPERATION::CS_PS_MODE1:
sValue = "1";
break;
case ICellularRadio::UE_MODES_OF_OPERATION::CS_PS_MODE2:
sValue = "2";
break;
default:
printError("%s| Set UE Mode Of Operation: invalid argument", getName().c_str());
return INVALID_ARGS;
}
const int dTimeout = 1000; // ms
const std::string sCommand = "AT+CEMODE=" + sValue;
return sendBasicCommand(sCommand, dTimeout);
}
ICellularRadio::CODE LE910Radio::getUeModeOfOperation(ICellularRadio::UE_MODES_OF_OPERATION& mode) {
printTrace("%s| Get UE Mode Of Operation", getName().c_str());
const std::string sCommand = "AT+CEMODE?";
const int dTimeout = 1000; // ms
std::string sResult = sendCommand(sCommand, ICellularRadio::DEFAULT_BAIL_STRINGS, dTimeout);
printTrace("%s| Got response from the radio: %s", getName().c_str(), sResult.c_str());
size_t end = sResult.rfind(ICellularRadio::RSP_OK);
if (std::string::npos == end) {
printError("%s| Unable to get UE Mode Of Operation from radio using command [%s]", getName().c_str(), sCommand.c_str());
return FAILURE;
}
const std::string sLabel = "+CEMODE: ";
size_t start = sResult.find(sLabel);
if (std::string::npos == start) {
printError("%s| Unable to get UE Mode Of Operation from radio using command [%s]", getName().c_str(), sCommand.c_str());
return FAILURE;
}
start += sLabel.length();
const std::string sValue = MTS::Text::trim(sResult.substr(start, end - start));
uint8_t uiValue;
if (!MTS::Text::parse(uiValue, sValue)) {
printError("%s| Unable to parse CEMODE from response [%s]", getName().c_str(), sResult.c_str());
return FAILURE;
}
CODE rc;
switch (uiValue) {
case 0:
mode = ICellularRadio::UE_MODES_OF_OPERATION::PS_MODE2;
rc = SUCCESS;
break;
case 1:
mode = ICellularRadio::UE_MODES_OF_OPERATION::CS_PS_MODE1;
rc = SUCCESS;
break;
case 2:
mode = ICellularRadio::UE_MODES_OF_OPERATION::CS_PS_MODE2;
rc = SUCCESS;
break;
case 3:
mode = ICellularRadio::UE_MODES_OF_OPERATION::PS_MODE1;
rc = SUCCESS;
break;
default:
printError("%s| Unable to parse CEMODE from response [%s]", getName().c_str(), sResult.c_str());
mode = ICellularRadio::UE_MODES_OF_OPERATION::UNKNOWN_MODE;
rc = FAILURE;
break;
}
return rc;
}
|
