| 1 | /**************************************************************************** | 
|---|
| 2 | ** | 
|---|
| 3 | ** Copyright (C) 2011 Nokia Corporation and/or its subsidiary(-ies). | 
|---|
| 4 | ** All rights reserved. | 
|---|
| 5 | ** Contact: Nokia Corporation (qt-info@nokia.com) | 
|---|
| 6 | ** | 
|---|
| 7 | ** This file is part of the tools applications of the Qt Toolkit. | 
|---|
| 8 | ** | 
|---|
| 9 | ** $QT_BEGIN_LICENSE:LGPL$ | 
|---|
| 10 | ** Commercial Usage | 
|---|
| 11 | ** Licensees holding valid Qt Commercial licenses may use this file in | 
|---|
| 12 | ** accordance with the Qt Commercial License Agreement provided with the | 
|---|
| 13 | ** Software or, alternatively, in accordance with the terms contained in | 
|---|
| 14 | ** a written agreement between you and Nokia. | 
|---|
| 15 | ** | 
|---|
| 16 | ** GNU Lesser General Public License Usage | 
|---|
| 17 | ** Alternatively, this file may be used under the terms of the GNU Lesser | 
|---|
| 18 | ** General Public License version 2.1 as published by the Free Software | 
|---|
| 19 | ** Foundation and appearing in the file LICENSE.LGPL included in the | 
|---|
| 20 | ** packaging of this file.  Please review the following information to | 
|---|
| 21 | ** ensure the GNU Lesser General Public License version 2.1 requirements | 
|---|
| 22 | ** will be met: http://www.gnu.org/licenses/old-licenses/lgpl-2.1.html. | 
|---|
| 23 | ** | 
|---|
| 24 | ** In addition, as a special exception, Nokia gives you certain additional | 
|---|
| 25 | ** rights.  These rights are described in the Nokia Qt LGPL Exception | 
|---|
| 26 | ** version 1.1, included in the file LGPL_EXCEPTION.txt in this package. | 
|---|
| 27 | ** | 
|---|
| 28 | ** GNU General Public License Usage | 
|---|
| 29 | ** Alternatively, this file may be used under the terms of the GNU | 
|---|
| 30 | ** General Public License version 3.0 as published by the Free Software | 
|---|
| 31 | ** Foundation and appearing in the file LICENSE.GPL included in the | 
|---|
| 32 | ** packaging of this file.  Please review the following information to | 
|---|
| 33 | ** ensure the GNU General Public License version 3.0 requirements will be | 
|---|
| 34 | ** met: http://www.gnu.org/copyleft/gpl.html. | 
|---|
| 35 | ** | 
|---|
| 36 | ** If you have questions regarding the use of this file, please contact | 
|---|
| 37 | ** Nokia at qt-info@nokia.com. | 
|---|
| 38 | ** $QT_END_LICENSE$ | 
|---|
| 39 | ** | 
|---|
| 40 | ****************************************************************************/ | 
|---|
| 41 |  | 
|---|
| 42 | #include "tcftrkdevice.h" | 
|---|
| 43 | #include "json.h" | 
|---|
| 44 |  | 
|---|
| 45 | #include <QtNetwork/QAbstractSocket> | 
|---|
| 46 | #include <QtCore/QDebug> | 
|---|
| 47 | #include <QtCore/QVector> | 
|---|
| 48 | #include <QtCore/QQueue> | 
|---|
| 49 | #include <QtCore/QTextStream> | 
|---|
| 50 | #include <QtCore/QDateTime> | 
|---|
| 51 | #include <QtCore/QFileInfo> | 
|---|
| 52 |  | 
|---|
| 53 | enum { debug = 0 }; | 
|---|
| 54 |  | 
|---|
| 55 | static const char messageTerminatorC[] = "\003\001"; | 
|---|
| 56 |  | 
|---|
| 57 | namespace tcftrk { | 
|---|
| 58 | // ------------- TcfTrkCommandError | 
|---|
| 59 |  | 
|---|
| 60 | TcfTrkCommandError::TcfTrkCommandError() : timeMS(0), code(0), alternativeCode(0) | 
|---|
| 61 | { | 
|---|
| 62 | } | 
|---|
| 63 |  | 
|---|
| 64 | void TcfTrkCommandError::clear() | 
|---|
| 65 | { | 
|---|
| 66 | timeMS = 0; | 
|---|
| 67 | code = alternativeCode = 0; | 
|---|
| 68 | format.clear(); | 
|---|
| 69 | alternativeOrganization.clear(); | 
|---|
| 70 | } | 
|---|
| 71 |  | 
|---|
| 72 | void TcfTrkCommandError::write(QTextStream &str) const | 
|---|
| 73 | { | 
|---|
| 74 | if (timeMS) { | 
|---|
| 75 | const QDateTime time(QDate(1970, 1, 1)); | 
|---|
| 76 | str << time.addMSecs(timeMS).toString(Qt::ISODate) << ": Error code: " << code | 
|---|
| 77 | << " '" << format << '\''; | 
|---|
| 78 | if (!alternativeOrganization.isEmpty()) | 
|---|
| 79 | str << " ('" << alternativeOrganization << "', code: " << alternativeCode << ')'; | 
|---|
| 80 | } else{ | 
|---|
| 81 | str << "<No error>"; | 
|---|
| 82 | } | 
|---|
| 83 | } | 
|---|
| 84 |  | 
|---|
| 85 | QString TcfTrkCommandError::toString() const | 
|---|
| 86 | { | 
|---|
| 87 | QString rc; | 
|---|
| 88 | QTextStream str(&rc); | 
|---|
| 89 | write(str); | 
|---|
| 90 | return rc; | 
|---|
| 91 | } | 
|---|
| 92 |  | 
|---|
| 93 | /* {"Time":1277459762255,"Code":1,"AltCode":-6,"AltOrg":"POSIX","Format":"Unknown error: -6"} */ | 
|---|
| 94 | bool TcfTrkCommandError::parse(const QVector<JsonValue> &values) | 
|---|
| 95 | { | 
|---|
| 96 | // Parse an arbitrary hash (that could as well be a command response) | 
|---|
| 97 | // and check for error elements. | 
|---|
| 98 | unsigned errorKeyCount = 0; | 
|---|
| 99 | clear(); | 
|---|
| 100 | do { | 
|---|
| 101 | if (values.isEmpty() || values.front().type() != JsonValue::Object) | 
|---|
| 102 | break; | 
|---|
| 103 | foreach (const JsonValue &c, values.front().children()) { | 
|---|
| 104 | if (c.name() == "Time") { | 
|---|
| 105 | timeMS = c.data().toULongLong(); | 
|---|
| 106 | errorKeyCount++; | 
|---|
| 107 | } else if (c.name() == "Code") { | 
|---|
| 108 | code = c.data().toInt(); | 
|---|
| 109 | errorKeyCount++; | 
|---|
| 110 | } else if (c.name() == "Format") { | 
|---|
| 111 | format = c.data(); | 
|---|
| 112 | errorKeyCount++; | 
|---|
| 113 | } else if (c.name() == "AltCode") { | 
|---|
| 114 | alternativeCode = c.data().toInt(); | 
|---|
| 115 | errorKeyCount++; | 
|---|
| 116 | } else if (c.name() == "AltOrg") { | 
|---|
| 117 | alternativeOrganization = c.data(); | 
|---|
| 118 | errorKeyCount++; | 
|---|
| 119 | } | 
|---|
| 120 | } | 
|---|
| 121 | } while (false); | 
|---|
| 122 | const bool errorFound = errorKeyCount >= 2u; // Should be at least 'Time', 'Code'. | 
|---|
| 123 | if (!errorFound) | 
|---|
| 124 | clear(); | 
|---|
| 125 | if (debug) { | 
|---|
| 126 | qDebug() << "TcfTrkCommandError::parse: Found error: " << errorFound; | 
|---|
| 127 | if (!values.isEmpty()) | 
|---|
| 128 | qDebug() << values.front().toString(); | 
|---|
| 129 | } | 
|---|
| 130 | return errorFound; | 
|---|
| 131 | } | 
|---|
| 132 |  | 
|---|
| 133 | // ------------ TcfTrkCommandResult | 
|---|
| 134 |  | 
|---|
| 135 | TcfTrkCommandResult::TcfTrkCommandResult(Type t) : | 
|---|
| 136 | type(t), service(LocatorService) | 
|---|
| 137 | { | 
|---|
| 138 | } | 
|---|
| 139 |  | 
|---|
| 140 | TcfTrkCommandResult::TcfTrkCommandResult(char typeChar, Services s, | 
|---|
| 141 | const QByteArray &r, | 
|---|
| 142 | const QVector<JsonValue> &v, | 
|---|
| 143 | const QVariant &ck) : | 
|---|
| 144 | type(FailReply), service(s), request(r), values(v), cookie(ck) | 
|---|
| 145 | { | 
|---|
| 146 | switch (typeChar) { | 
|---|
| 147 | case 'N': | 
|---|
| 148 | type = FailReply; | 
|---|
| 149 | break; | 
|---|
| 150 | case 'P': | 
|---|
| 151 | type = ProgressReply; | 
|---|
| 152 | break; | 
|---|
| 153 | case 'R': | 
|---|
| 154 | type = commandError.parse(values) ? CommandErrorReply : SuccessReply; | 
|---|
| 155 | break; | 
|---|
| 156 | default: | 
|---|
| 157 | qWarning("Unknown TCF reply type '%c'", typeChar); | 
|---|
| 158 | } | 
|---|
| 159 | } | 
|---|
| 160 |  | 
|---|
| 161 | QString TcfTrkCommandResult::errorString() const | 
|---|
| 162 | { | 
|---|
| 163 | QString rc; | 
|---|
| 164 | QTextStream str(&rc); | 
|---|
| 165 |  | 
|---|
| 166 | switch (type) { | 
|---|
| 167 | case SuccessReply: | 
|---|
| 168 | case ProgressReply: | 
|---|
| 169 | str << "<No error>"; | 
|---|
| 170 | return rc; | 
|---|
| 171 | case FailReply: | 
|---|
| 172 | str << "NAK"; | 
|---|
| 173 | case CommandErrorReply: | 
|---|
| 174 | commandError.write(str); | 
|---|
| 175 | break; | 
|---|
| 176 | } | 
|---|
| 177 | // Append the failed command for reference | 
|---|
| 178 | str << " (Command was: '"; | 
|---|
| 179 | QByteArray printableRequest = request; | 
|---|
| 180 | printableRequest.replace('\0', '|'); | 
|---|
| 181 | str << printableRequest << "')"; | 
|---|
| 182 | return rc; | 
|---|
| 183 | } | 
|---|
| 184 |  | 
|---|
| 185 | QString TcfTrkCommandResult::toString() const | 
|---|
| 186 | { | 
|---|
| 187 | QString rc; | 
|---|
| 188 | QTextStream str(&rc); | 
|---|
| 189 | str << "Command answer "; | 
|---|
| 190 | switch (type) { | 
|---|
| 191 | case SuccessReply: | 
|---|
| 192 | str << "[success]"; | 
|---|
| 193 | break; | 
|---|
| 194 | case CommandErrorReply: | 
|---|
| 195 | str << "[command error]"; | 
|---|
| 196 | break; | 
|---|
| 197 | case FailReply: | 
|---|
| 198 | str << "[fail (NAK)]"; | 
|---|
| 199 | break; | 
|---|
| 200 | case ProgressReply: | 
|---|
| 201 | str << "[progress]"; | 
|---|
| 202 | break; | 
|---|
| 203 | } | 
|---|
| 204 | str << ", " << values.size() << " values(s) to request: '"; | 
|---|
| 205 | QByteArray printableRequest = request; | 
|---|
| 206 | printableRequest.replace('\0', '|'); | 
|---|
| 207 | str << printableRequest << "' "; | 
|---|
| 208 | if (cookie.isValid()) | 
|---|
| 209 | str << " cookie: " << cookie.toString(); | 
|---|
| 210 | str << '\n'; | 
|---|
| 211 | for (int i = 0, count = values.size(); i < count; i++) | 
|---|
| 212 | str << '#' << i << ' ' << values.at(i).toString() << '\n'; | 
|---|
| 213 | if (type == CommandErrorReply) | 
|---|
| 214 | str << "Error: " << errorString(); | 
|---|
| 215 | return rc; | 
|---|
| 216 | } | 
|---|
| 217 |  | 
|---|
| 218 | struct TcfTrkSendQueueEntry | 
|---|
| 219 | { | 
|---|
| 220 | typedef TcfTrkDevice::MessageType MessageType; | 
|---|
| 221 |  | 
|---|
| 222 | explicit TcfTrkSendQueueEntry(MessageType mt, | 
|---|
| 223 | int tok, | 
|---|
| 224 | Services s, | 
|---|
| 225 | const QByteArray &d, | 
|---|
| 226 | const TcfTrkCallback &cb= TcfTrkCallback(), | 
|---|
| 227 | const QVariant &ck = QVariant()) : | 
|---|
| 228 | messageType(mt), service(s), data(d), token(tok), cookie(ck), callback(cb)  {} | 
|---|
| 229 |  | 
|---|
| 230 | MessageType messageType; | 
|---|
| 231 | Services service; | 
|---|
| 232 | QByteArray data; | 
|---|
| 233 | int token; | 
|---|
| 234 | QVariant cookie; | 
|---|
| 235 | TcfTrkCallback callback; | 
|---|
| 236 | }; | 
|---|
| 237 |  | 
|---|
| 238 | struct TcfTrkDevicePrivate { | 
|---|
| 239 | typedef TcfTrkDevice::IODevicePtr IODevicePtr; | 
|---|
| 240 | typedef QHash<int, TcfTrkSendQueueEntry> TokenWrittenMessageMap; | 
|---|
| 241 |  | 
|---|
| 242 | TcfTrkDevicePrivate(); | 
|---|
| 243 |  | 
|---|
| 244 | const QByteArray m_messageTerminator; | 
|---|
| 245 |  | 
|---|
| 246 | IODevicePtr m_device; | 
|---|
| 247 | unsigned m_verbose; | 
|---|
| 248 | QByteArray m_readBuffer; | 
|---|
| 249 | int m_token; | 
|---|
| 250 | QQueue<TcfTrkSendQueueEntry> m_sendQueue; | 
|---|
| 251 | TokenWrittenMessageMap m_writtenMessages; | 
|---|
| 252 | QVector<QByteArray> m_registerNames; | 
|---|
| 253 | }; | 
|---|
| 254 |  | 
|---|
| 255 | TcfTrkDevicePrivate::TcfTrkDevicePrivate() : | 
|---|
| 256 | m_messageTerminator(messageTerminatorC), | 
|---|
| 257 | m_verbose(0), m_token(0) | 
|---|
| 258 | { | 
|---|
| 259 | } | 
|---|
| 260 |  | 
|---|
| 261 | TcfTrkDevice::TcfTrkDevice(QObject *parent) : | 
|---|
| 262 | QObject(parent), d(new TcfTrkDevicePrivate) | 
|---|
| 263 | { | 
|---|
| 264 | } | 
|---|
| 265 |  | 
|---|
| 266 | TcfTrkDevice::~TcfTrkDevice() | 
|---|
| 267 | { | 
|---|
| 268 | delete d; | 
|---|
| 269 | } | 
|---|
| 270 |  | 
|---|
| 271 | QVector<QByteArray> TcfTrkDevice::registerNames() const | 
|---|
| 272 | { | 
|---|
| 273 | return d->m_registerNames; | 
|---|
| 274 | } | 
|---|
| 275 |  | 
|---|
| 276 | void TcfTrkDevice::setRegisterNames(const QVector<QByteArray>& n) | 
|---|
| 277 | { | 
|---|
| 278 | d->m_registerNames = n; | 
|---|
| 279 | if (d->m_verbose) { | 
|---|
| 280 | QString msg; | 
|---|
| 281 | QTextStream str(&msg); | 
|---|
| 282 | const int count = n.size(); | 
|---|
| 283 | str << "Registers (" << count << "): "; | 
|---|
| 284 | for (int i = 0; i < count; i++) | 
|---|
| 285 | str << '#' << i << '=' << n.at(i) << ' '; | 
|---|
| 286 | emitLogMessage(msg); | 
|---|
| 287 | } | 
|---|
| 288 | } | 
|---|
| 289 |  | 
|---|
| 290 | TcfTrkDevice::IODevicePtr TcfTrkDevice::device() const | 
|---|
| 291 | { | 
|---|
| 292 | return d->m_device; | 
|---|
| 293 | } | 
|---|
| 294 |  | 
|---|
| 295 | TcfTrkDevice::IODevicePtr TcfTrkDevice::takeDevice() | 
|---|
| 296 | { | 
|---|
| 297 | const IODevicePtr old = d->m_device; | 
|---|
| 298 | if (!old.isNull()) { | 
|---|
| 299 | old.data()->disconnect(this); | 
|---|
| 300 | d->m_device = IODevicePtr(); | 
|---|
| 301 | } | 
|---|
| 302 | d->m_readBuffer.clear(); | 
|---|
| 303 | d->m_token = 0; | 
|---|
| 304 | d->m_sendQueue.clear(); | 
|---|
| 305 | return old; | 
|---|
| 306 | } | 
|---|
| 307 |  | 
|---|
| 308 | void TcfTrkDevice::setDevice(const IODevicePtr &dp) | 
|---|
| 309 | { | 
|---|
| 310 | if (dp.data() == d->m_device.data()) | 
|---|
| 311 | return; | 
|---|
| 312 | if (dp.isNull()) { | 
|---|
| 313 | emitLogMessage(QLatin1String("Internal error: Attempt to set NULL device.")); | 
|---|
| 314 | return; | 
|---|
| 315 | } | 
|---|
| 316 | takeDevice(); | 
|---|
| 317 | d->m_device = dp; | 
|---|
| 318 | connect(dp.data(), SIGNAL(readyRead()), this, SLOT(slotDeviceReadyRead())); | 
|---|
| 319 | if (QAbstractSocket *s = qobject_cast<QAbstractSocket *>(dp.data())) { | 
|---|
| 320 | connect(s, SIGNAL(error(QAbstractSocket::SocketError)), this, SLOT(slotDeviceError())); | 
|---|
| 321 | connect(s, SIGNAL(stateChanged(QAbstractSocket::SocketState)), this, SLOT(slotDeviceSocketStateChanged())); | 
|---|
| 322 | } | 
|---|
| 323 | } | 
|---|
| 324 |  | 
|---|
| 325 | void TcfTrkDevice::slotDeviceError() | 
|---|
| 326 | { | 
|---|
| 327 | const QString message = d->m_device->errorString(); | 
|---|
| 328 | emitLogMessage(message); | 
|---|
| 329 | emit error(message); | 
|---|
| 330 | } | 
|---|
| 331 |  | 
|---|
| 332 | void TcfTrkDevice::slotDeviceSocketStateChanged() | 
|---|
| 333 | { | 
|---|
| 334 | if (const QAbstractSocket *s = qobject_cast<const QAbstractSocket *>(d->m_device.data())) { | 
|---|
| 335 | const QAbstractSocket::SocketState st = s->state(); | 
|---|
| 336 | switch (st) { | 
|---|
| 337 | case QAbstractSocket::UnconnectedState: | 
|---|
| 338 | emitLogMessage(QLatin1String("Unconnected")); | 
|---|
| 339 | break; | 
|---|
| 340 | case QAbstractSocket::HostLookupState: | 
|---|
| 341 | emitLogMessage(QLatin1String("HostLookupState")); | 
|---|
| 342 | break; | 
|---|
| 343 | case QAbstractSocket::ConnectingState: | 
|---|
| 344 | emitLogMessage(QLatin1String("Connecting")); | 
|---|
| 345 | break; | 
|---|
| 346 | case QAbstractSocket::ConnectedState: | 
|---|
| 347 | emitLogMessage(QLatin1String("Connected")); | 
|---|
| 348 | break; | 
|---|
| 349 | case QAbstractSocket::ClosingState: | 
|---|
| 350 | emitLogMessage(QLatin1String("Closing")); | 
|---|
| 351 | break; | 
|---|
| 352 | default: | 
|---|
| 353 | emitLogMessage(QString::fromLatin1("State %1").arg(st)); | 
|---|
| 354 | break; | 
|---|
| 355 | } | 
|---|
| 356 | } | 
|---|
| 357 | } | 
|---|
| 358 |  | 
|---|
| 359 | static inline QString debugMessage(QByteArray  message, const char *prefix = 0) | 
|---|
| 360 | { | 
|---|
| 361 | message.replace('\0', '|'); | 
|---|
| 362 | const QString messageS = QString::fromLatin1(message); | 
|---|
| 363 | return prefix ? | 
|---|
| 364 | (QLatin1String(prefix) + messageS) :  messageS; | 
|---|
| 365 | } | 
|---|
| 366 |  | 
|---|
| 367 | void TcfTrkDevice::slotDeviceReadyRead() | 
|---|
| 368 | { | 
|---|
| 369 | d->m_readBuffer += d->m_device->readAll(); | 
|---|
| 370 | // Take complete message off front of readbuffer. | 
|---|
| 371 | do { | 
|---|
| 372 | const int messageEndPos = d->m_readBuffer.indexOf(d->m_messageTerminator); | 
|---|
| 373 | if (messageEndPos == -1) | 
|---|
| 374 | break; | 
|---|
| 375 | const QByteArray message = d->m_readBuffer.left(messageEndPos); | 
|---|
| 376 | if (debug) | 
|---|
| 377 | qDebug("Read:\n%s", qPrintable(formatData(message))); | 
|---|
| 378 | if (const int errorCode = parseMessage(message)) { | 
|---|
| 379 | emitLogMessage(QString::fromLatin1("Parse error %1 for: %2").arg(errorCode).arg(debugMessage(message))); | 
|---|
| 380 | } | 
|---|
| 381 | d->m_readBuffer.remove(0, messageEndPos + d->m_messageTerminator.size()); | 
|---|
| 382 | } while (!d->m_readBuffer.isEmpty()); | 
|---|
| 383 | checkSendQueue(); // Send off further message | 
|---|
| 384 | } | 
|---|
| 385 |  | 
|---|
| 386 | // Split \0-terminated message into tokens, skipping the initial type character | 
|---|
| 387 | static inline QVector<QByteArray> splitMessage(const QByteArray &message) | 
|---|
| 388 | { | 
|---|
| 389 | QVector<QByteArray> tokens; | 
|---|
| 390 | tokens.reserve(7); | 
|---|
| 391 | const int messageSize = message.size(); | 
|---|
| 392 | for (int pos = 2; pos < messageSize; ) { | 
|---|
| 393 | const int nextPos = message.indexOf('\0', pos); | 
|---|
| 394 | if (nextPos == -1) | 
|---|
| 395 | break; | 
|---|
| 396 | tokens.push_back(message.mid(pos, nextPos - pos)); | 
|---|
| 397 | pos = nextPos + 1; | 
|---|
| 398 | } | 
|---|
| 399 | return tokens; | 
|---|
| 400 | } | 
|---|
| 401 |  | 
|---|
| 402 | int TcfTrkDevice::parseMessage(const QByteArray &message) | 
|---|
| 403 | { | 
|---|
| 404 | if (d->m_verbose) | 
|---|
| 405 | emitLogMessage(debugMessage(message, "TCF ->")); | 
|---|
| 406 | // Special JSON parse error message or protocol format error. | 
|---|
| 407 | // The port is usually closed after receiving it. | 
|---|
| 408 | // "\3\2{"Time":1276096098255,"Code":3,"Format": "Protocol format error"}" | 
|---|
| 409 | if (message.startsWith("\003\002")) { | 
|---|
| 410 | QByteArray text = message.mid(2); | 
|---|
| 411 | const QString errorMessage = QString::fromLatin1("Parse error received: %1").arg(QString::fromAscii(text)); | 
|---|
| 412 | emit error(errorMessage); | 
|---|
| 413 | return 0; | 
|---|
| 414 | } | 
|---|
| 415 | if (message.size() < 4 || message.at(1) != '\0') | 
|---|
| 416 | return 1; | 
|---|
| 417 | // Split into tokens | 
|---|
| 418 | const char type = message.at(0); | 
|---|
| 419 | const QVector<QByteArray> tokens = splitMessage(message); | 
|---|
| 420 | switch (type) { | 
|---|
| 421 | case 'E': | 
|---|
| 422 | return parseTcfEvent(tokens); | 
|---|
| 423 | case 'R': // Command replies | 
|---|
| 424 | case 'N': | 
|---|
| 425 | case 'P': | 
|---|
| 426 | return parseTcfCommandReply(type, tokens); | 
|---|
| 427 | default: | 
|---|
| 428 | emitLogMessage(QString::fromLatin1("Unhandled message type: %1").arg(debugMessage(message))); | 
|---|
| 429 | return 756; | 
|---|
| 430 | } | 
|---|
| 431 | return 0; | 
|---|
| 432 | } | 
|---|
| 433 |  | 
|---|
| 434 | int TcfTrkDevice::parseTcfCommandReply(char type, const QVector<QByteArray> &tokens) | 
|---|
| 435 | { | 
|---|
| 436 | typedef TcfTrkDevicePrivate::TokenWrittenMessageMap::iterator TokenWrittenMessageMapIterator; | 
|---|
| 437 | // Find the corresponding entry in the written messages hash. | 
|---|
| 438 | const int tokenCount = tokens.size(); | 
|---|
| 439 | if (tokenCount < 1) | 
|---|
| 440 | return 234; | 
|---|
| 441 | bool tokenOk; | 
|---|
| 442 | const int token = tokens.at(0).toInt(&tokenOk); | 
|---|
| 443 | if (!tokenOk) | 
|---|
| 444 | return 235; | 
|---|
| 445 | const TokenWrittenMessageMapIterator it = d->m_writtenMessages.find(token); | 
|---|
| 446 | if (it == d->m_writtenMessages.end()) { | 
|---|
| 447 | qWarning("TcfTrkDevice: Internal error: token %d not found for '%s'", | 
|---|
| 448 | token, qPrintable(joinByteArrays(tokens))); | 
|---|
| 449 | return 236; | 
|---|
| 450 | } | 
|---|
| 451 | // No callback: remove entry from map, happy | 
|---|
| 452 | if (!it.value().callback) { | 
|---|
| 453 | d->m_writtenMessages.erase(it); | 
|---|
| 454 | return 0; | 
|---|
| 455 | } | 
|---|
| 456 | // Parse values into JSON | 
|---|
| 457 | QVector<JsonValue> values; | 
|---|
| 458 | values.reserve(tokenCount); | 
|---|
| 459 | for (int i = 1; i < tokenCount; i++) { | 
|---|
| 460 | if (!tokens.at(i).isEmpty()) { // Strange: Empty tokens occur. | 
|---|
| 461 | const JsonValue value(tokens.at(i)); | 
|---|
| 462 | if (value.isValid()) { | 
|---|
| 463 | values.push_back(value); | 
|---|
| 464 | } else { | 
|---|
| 465 | qWarning("JSON parse error for reply to command token %d: #%d '%s'", | 
|---|
| 466 | token, i, tokens.at(i).constData()); | 
|---|
| 467 | d->m_writtenMessages.erase(it); | 
|---|
| 468 | return -1; | 
|---|
| 469 | } | 
|---|
| 470 | } | 
|---|
| 471 | } | 
|---|
| 472 |  | 
|---|
| 473 | // Construct result and invoke callback, remove entry from map. | 
|---|
| 474 | TcfTrkCallback callback = it.value().callback; | 
|---|
| 475 | TcfTrkCommandResult result(type, it.value().service, it.value().data, | 
|---|
| 476 | values, it.value().cookie); | 
|---|
| 477 | d->m_writtenMessages.erase(it); | 
|---|
| 478 | callback(result); | 
|---|
| 479 | return 0; | 
|---|
| 480 | } | 
|---|
| 481 |  | 
|---|
| 482 | static const char locatorAnswerC[] = "E\0Locator\0Hello\0[\"Locator\"]"; | 
|---|
| 483 |  | 
|---|
| 484 | int TcfTrkDevice::parseTcfEvent(const QVector<QByteArray> &tokens) | 
|---|
| 485 | { | 
|---|
| 486 | // Event: Ignore the periodical heartbeat event, answer 'Hello', | 
|---|
| 487 | // emit signal for the rest | 
|---|
| 488 | if (tokens.size() < 3) | 
|---|
| 489 | return 433; | 
|---|
| 490 | const Services service = serviceFromName(tokens.at(0).constData()); | 
|---|
| 491 | if (service == LocatorService && tokens.at(1) == "peerHeartBeat") | 
|---|
| 492 | return 0; | 
|---|
| 493 | QVector<JsonValue> values; | 
|---|
| 494 | for (int i = 2; i < tokens.size(); i++) { | 
|---|
| 495 | const JsonValue value(tokens.at(i)); | 
|---|
| 496 | if (!value.isValid()) | 
|---|
| 497 | return 434; | 
|---|
| 498 | values.push_back(value); | 
|---|
| 499 | } | 
|---|
| 500 | // Parse known events, emit signals | 
|---|
| 501 | QScopedPointer<TcfTrkEvent> knownEvent(TcfTrkEvent::parseEvent(service, tokens.at(1), values)); | 
|---|
| 502 | if (!knownEvent.isNull()) { | 
|---|
| 503 | // Answer hello event. | 
|---|
| 504 | if (knownEvent->type() == TcfTrkEvent::LocatorHello) | 
|---|
| 505 | writeMessage(QByteArray(locatorAnswerC, sizeof(locatorAnswerC))); | 
|---|
| 506 | emit tcfEvent(*knownEvent); | 
|---|
| 507 | } | 
|---|
| 508 | emit genericTcfEvent(service, tokens.at(1), values); | 
|---|
| 509 |  | 
|---|
| 510 | if (debug || d->m_verbose) { | 
|---|
| 511 | QString msg; | 
|---|
| 512 | QTextStream str(&msg); | 
|---|
| 513 | if (knownEvent.isNull()) { | 
|---|
| 514 | str << "Event: " << tokens.at(0) << ' ' << tokens.at(1) << '\n'; | 
|---|
| 515 | foreach(const JsonValue &val, values) | 
|---|
| 516 | str << "  " << val.toString() << '\n'; | 
|---|
| 517 | } else { | 
|---|
| 518 | str << knownEvent->toString(); | 
|---|
| 519 | } | 
|---|
| 520 | emitLogMessage(msg); | 
|---|
| 521 | } | 
|---|
| 522 |  | 
|---|
| 523 | return 0; | 
|---|
| 524 | } | 
|---|
| 525 |  | 
|---|
| 526 | unsigned TcfTrkDevice::verbose() const | 
|---|
| 527 | { | 
|---|
| 528 | return d->m_verbose; | 
|---|
| 529 | } | 
|---|
| 530 |  | 
|---|
| 531 | void TcfTrkDevice::setVerbose(unsigned v) | 
|---|
| 532 | { | 
|---|
| 533 | d->m_verbose = v; | 
|---|
| 534 | } | 
|---|
| 535 |  | 
|---|
| 536 | void TcfTrkDevice::emitLogMessage(const QString &m) | 
|---|
| 537 | { | 
|---|
| 538 | if (debug) | 
|---|
| 539 | qWarning("%s", qPrintable(m)); | 
|---|
| 540 | emit logMessage(m); | 
|---|
| 541 | } | 
|---|
| 542 |  | 
|---|
| 543 | bool TcfTrkDevice::checkOpen() | 
|---|
| 544 | { | 
|---|
| 545 | if (d->m_device.isNull()) { | 
|---|
| 546 | emitLogMessage(QLatin1String("Internal error: No device set on TcfTrkDevice.")); | 
|---|
| 547 | return false; | 
|---|
| 548 | } | 
|---|
| 549 | if (!d->m_device->isOpen()) { | 
|---|
| 550 | emitLogMessage(QLatin1String("Internal error: Device not open in TcfTrkDevice.")); | 
|---|
| 551 | return false; | 
|---|
| 552 | } | 
|---|
| 553 | return true; | 
|---|
| 554 | } | 
|---|
| 555 |  | 
|---|
| 556 | void TcfTrkDevice::sendTcfTrkMessage(MessageType mt, Services service, const char *command, | 
|---|
| 557 | const char *commandParameters, int commandParametersLength, | 
|---|
| 558 | const TcfTrkCallback &callBack, | 
|---|
| 559 | const QVariant &cookie) | 
|---|
| 560 |  | 
|---|
| 561 | { | 
|---|
| 562 | if (!checkOpen()) | 
|---|
| 563 | return; | 
|---|
| 564 | // Format the message | 
|---|
| 565 | const int  token = d->m_token++; | 
|---|
| 566 | QByteArray data; | 
|---|
| 567 | data.reserve(30 + commandParametersLength); | 
|---|
| 568 | data.append('C'); | 
|---|
| 569 | data.append('\0'); | 
|---|
| 570 | data.append(QByteArray::number(token)); | 
|---|
| 571 | data.append('\0'); | 
|---|
| 572 | data.append(serviceName(service)); | 
|---|
| 573 | data.append('\0'); | 
|---|
| 574 | data.append(command); | 
|---|
| 575 | data.append('\0'); | 
|---|
| 576 | if (commandParametersLength) | 
|---|
| 577 | data.append(commandParameters, commandParametersLength); | 
|---|
| 578 | const TcfTrkSendQueueEntry entry(mt, token, service, data, callBack, cookie); | 
|---|
| 579 | d->m_sendQueue.enqueue(entry); | 
|---|
| 580 | checkSendQueue(); | 
|---|
| 581 | } | 
|---|
| 582 |  | 
|---|
| 583 | void TcfTrkDevice::sendTcfTrkMessage(MessageType mt, Services service, const char *command, | 
|---|
| 584 | const QByteArray &commandParameters, | 
|---|
| 585 | const TcfTrkCallback &callBack, | 
|---|
| 586 | const QVariant &cookie) | 
|---|
| 587 | { | 
|---|
| 588 | sendTcfTrkMessage(mt, service, command, commandParameters.constData(), commandParameters.size(), | 
|---|
| 589 | callBack, cookie); | 
|---|
| 590 | } | 
|---|
| 591 |  | 
|---|
| 592 | // Enclose in message frame and write. | 
|---|
| 593 | void TcfTrkDevice::writeMessage(QByteArray data) | 
|---|
| 594 | { | 
|---|
| 595 | if (!checkOpen()) | 
|---|
| 596 | return; | 
|---|
| 597 |  | 
|---|
| 598 | if (d->m_verbose) | 
|---|
| 599 | emitLogMessage(debugMessage(data, "TCF <-")); | 
|---|
| 600 |  | 
|---|
| 601 | // Ensure \0-termination which easily gets lost in QByteArray CT. | 
|---|
| 602 | if (!data.endsWith('\0')) | 
|---|
| 603 | data.append('\0'); | 
|---|
| 604 | data += d->m_messageTerminator; | 
|---|
| 605 |  | 
|---|
| 606 | if (debug > 1) | 
|---|
| 607 | qDebug("Writing:\n%s", qPrintable(formatData(data))); | 
|---|
| 608 |  | 
|---|
| 609 | d->m_device->write(data); | 
|---|
| 610 | if (QAbstractSocket *as = qobject_cast<QAbstractSocket *>(d->m_device.data())) | 
|---|
| 611 | as->flush(); | 
|---|
| 612 | } | 
|---|
| 613 |  | 
|---|
| 614 | void TcfTrkDevice::checkSendQueue() | 
|---|
| 615 | { | 
|---|
| 616 | // Fire off messages or invoke noops until a message with reply is found | 
|---|
| 617 | // and an entry to writtenMessages is made. | 
|---|
| 618 | while (d->m_writtenMessages.empty()) { | 
|---|
| 619 | if (d->m_sendQueue.isEmpty()) | 
|---|
| 620 | break; | 
|---|
| 621 | TcfTrkSendQueueEntry entry = d->m_sendQueue.dequeue(); | 
|---|
| 622 | switch (entry.messageType) { | 
|---|
| 623 | case MessageWithReply: | 
|---|
| 624 | d->m_writtenMessages.insert(entry.token, entry); | 
|---|
| 625 | writeMessage(entry.data); | 
|---|
| 626 | break; | 
|---|
| 627 | case MessageWithoutReply: | 
|---|
| 628 | writeMessage(entry.data); | 
|---|
| 629 | break; | 
|---|
| 630 | case NoopMessage: // Invoke the noop-callback for synchronization | 
|---|
| 631 | if (entry.callback) { | 
|---|
| 632 | TcfTrkCommandResult noopResult(TcfTrkCommandResult::SuccessReply); | 
|---|
| 633 | noopResult.cookie = entry.cookie; | 
|---|
| 634 | entry.callback(noopResult); | 
|---|
| 635 | } | 
|---|
| 636 | break; | 
|---|
| 637 | } | 
|---|
| 638 | } | 
|---|
| 639 | } | 
|---|
| 640 |  | 
|---|
| 641 | // Fix slashes | 
|---|
| 642 | static inline QString fixFileName(QString in) | 
|---|
| 643 | { | 
|---|
| 644 | in.replace(QLatin1Char('/'), QLatin1Char('\\')); | 
|---|
| 645 | return in; | 
|---|
| 646 | } | 
|---|
| 647 |  | 
|---|
| 648 | // Start a process (consisting of a non-reply setSettings and start). | 
|---|
| 649 | void TcfTrkDevice::sendProcessStartCommand(const TcfTrkCallback &callBack, | 
|---|
| 650 | const QString &binaryIn, | 
|---|
| 651 | unsigned uid, | 
|---|
| 652 | QStringList arguments, | 
|---|
| 653 | QString workingDirectory, | 
|---|
| 654 | bool debugControl, | 
|---|
| 655 | const QStringList &additionalLibraries, | 
|---|
| 656 | const QVariant &cookie) | 
|---|
| 657 | { | 
|---|
| 658 | // Obtain the bin directory, expand by c:/sys/bin if missing | 
|---|
| 659 | const QChar backSlash('\\'); | 
|---|
| 660 | int slashPos = binaryIn.lastIndexOf(QLatin1Char('/')); | 
|---|
| 661 | if (slashPos == -1) | 
|---|
| 662 | slashPos = binaryIn.lastIndexOf(backSlash); | 
|---|
| 663 | const QString sysBin = QLatin1String("c:/sys/bin"); | 
|---|
| 664 | const QString binaryFileName  = slashPos == -1 ? binaryIn : binaryIn.mid(slashPos + 1); | 
|---|
| 665 | const QString binaryDirectory = slashPos == -1 ? sysBin : binaryIn.left(slashPos); | 
|---|
| 666 | const QString binary = fixFileName(binaryDirectory + QLatin1Char('/') + binaryFileName); | 
|---|
| 667 |  | 
|---|
| 668 | // Fixup: Does argv[0] convention exist on Symbian? | 
|---|
| 669 | arguments.push_front(binary); | 
|---|
| 670 | if (workingDirectory.isEmpty()) | 
|---|
| 671 | workingDirectory = sysBin; | 
|---|
| 672 |  | 
|---|
| 673 | // Format settings with empty dummy parameter | 
|---|
| 674 | QByteArray setData; | 
|---|
| 675 | JsonInputStream setStr(setData); | 
|---|
| 676 | setStr << "" << '\0' | 
|---|
| 677 | << '[' << "exeToLaunch" << ',' << "addExecutables" << ',' << "addLibraries" << ']' | 
|---|
| 678 | << '\0' << '[' | 
|---|
| 679 | << binary << ',' | 
|---|
| 680 | << '{' << binaryFileName << ':' << QString::number(uid, 16) << '}' << ',' | 
|---|
| 681 | << additionalLibraries | 
|---|
| 682 | << ']'; | 
|---|
| 683 | sendTcfTrkMessage(MessageWithoutReply, SettingsService, "set", setData); | 
|---|
| 684 |  | 
|---|
| 685 | QByteArray startData; | 
|---|
| 686 | JsonInputStream startStr(startData); | 
|---|
| 687 | startStr << fixFileName(workingDirectory) | 
|---|
| 688 | << '\0' << binary << '\0' << arguments << '\0' | 
|---|
| 689 | << QStringList() << '\0' // Env is an array ["PATH=value"] (non-standard) | 
|---|
| 690 | << debugControl; | 
|---|
| 691 | sendTcfTrkMessage(MessageWithReply, ProcessesService, "start", startData, callBack, cookie); | 
|---|
| 692 | } | 
|---|
| 693 |  | 
|---|
| 694 | void TcfTrkDevice::sendProcessTerminateCommand(const TcfTrkCallback &callBack, | 
|---|
| 695 | const QByteArray &id, | 
|---|
| 696 | const QVariant &cookie) | 
|---|
| 697 | { | 
|---|
| 698 | QByteArray data; | 
|---|
| 699 | JsonInputStream str(data); | 
|---|
| 700 | str << id; | 
|---|
| 701 | sendTcfTrkMessage(MessageWithReply, ProcessesService, "terminate", data, callBack, cookie); | 
|---|
| 702 | } | 
|---|
| 703 |  | 
|---|
| 704 | void TcfTrkDevice::sendRunControlTerminateCommand(const TcfTrkCallback &callBack, | 
|---|
| 705 | const QByteArray &id, | 
|---|
| 706 | const QVariant &cookie) | 
|---|
| 707 | { | 
|---|
| 708 | QByteArray data; | 
|---|
| 709 | JsonInputStream str(data); | 
|---|
| 710 | str << id; | 
|---|
| 711 | sendTcfTrkMessage(MessageWithReply, RunControlService, "terminate", data, callBack, cookie); | 
|---|
| 712 | } | 
|---|
| 713 |  | 
|---|
| 714 | // Non-standard: Remove executable from settings | 
|---|
| 715 | void TcfTrkDevice::sendSettingsRemoveExecutableCommand(const QString &binaryIn, | 
|---|
| 716 | unsigned uid, | 
|---|
| 717 | const QStringList &additionalLibraries, | 
|---|
| 718 | const QVariant &cookie) | 
|---|
| 719 | { | 
|---|
| 720 | QByteArray setData; | 
|---|
| 721 | JsonInputStream setStr(setData); | 
|---|
| 722 | setStr << "" << '\0' | 
|---|
| 723 | << '[' << "removedExecutables" << ',' << "removedLibraries" << ']' | 
|---|
| 724 | << '\0' << '[' | 
|---|
| 725 | << '{' << QFileInfo(binaryIn).fileName() << ':' << QString::number(uid, 16) << '}' << ',' | 
|---|
| 726 | << additionalLibraries | 
|---|
| 727 | << ']'; | 
|---|
| 728 | sendTcfTrkMessage(MessageWithoutReply, SettingsService, "set", setData, TcfTrkCallback(), cookie); | 
|---|
| 729 | } | 
|---|
| 730 |  | 
|---|
| 731 | void TcfTrkDevice::sendRunControlResumeCommand(const TcfTrkCallback &callBack, | 
|---|
| 732 | const QByteArray &id, | 
|---|
| 733 | RunControlResumeMode mode, | 
|---|
| 734 | unsigned count, | 
|---|
| 735 | quint64 rangeStart, | 
|---|
| 736 | quint64 rangeEnd, | 
|---|
| 737 | const QVariant &cookie) | 
|---|
| 738 | { | 
|---|
| 739 | QByteArray resumeData; | 
|---|
| 740 | JsonInputStream str(resumeData); | 
|---|
| 741 | str << id << '\0' << int(mode) << '\0' << count; | 
|---|
| 742 | switch (mode) { | 
|---|
| 743 | case RM_STEP_OVER_RANGE: | 
|---|
| 744 | case RM_STEP_INTO_RANGE: | 
|---|
| 745 | case RM_REVERSE_STEP_OVER_RANGE: | 
|---|
| 746 | case RM_REVERSE_STEP_INTO_RANGE: | 
|---|
| 747 | str << '\0' << '{' << "RANGE_START" << ':' << rangeStart | 
|---|
| 748 | << ',' << "RANGE_END" << ':' << rangeEnd << '}'; | 
|---|
| 749 | break; | 
|---|
| 750 | default: | 
|---|
| 751 | break; | 
|---|
| 752 | } | 
|---|
| 753 | sendTcfTrkMessage(MessageWithReply, RunControlService, "resume", resumeData, callBack, cookie); | 
|---|
| 754 | } | 
|---|
| 755 |  | 
|---|
| 756 | void TcfTrkDevice::sendRunControlSuspendCommand(const TcfTrkCallback &callBack, | 
|---|
| 757 | const QByteArray &id, | 
|---|
| 758 | const QVariant &cookie) | 
|---|
| 759 | { | 
|---|
| 760 | QByteArray data; | 
|---|
| 761 | JsonInputStream str(data); | 
|---|
| 762 | str << id; | 
|---|
| 763 | sendTcfTrkMessage(MessageWithReply, RunControlService, "suspend", data, callBack, cookie); | 
|---|
| 764 | } | 
|---|
| 765 |  | 
|---|
| 766 | void TcfTrkDevice::sendRunControlResumeCommand(const TcfTrkCallback &callBack, | 
|---|
| 767 | const QByteArray &id, | 
|---|
| 768 | const QVariant &cookie) | 
|---|
| 769 | { | 
|---|
| 770 | sendRunControlResumeCommand(callBack, id, RM_RESUME, 1, 0, 0, cookie); | 
|---|
| 771 | } | 
|---|
| 772 |  | 
|---|
| 773 | void TcfTrkDevice::sendBreakpointsAddCommand(const TcfTrkCallback &callBack, | 
|---|
| 774 | const Breakpoint &bp, | 
|---|
| 775 | const QVariant &cookie) | 
|---|
| 776 | { | 
|---|
| 777 | QByteArray data; | 
|---|
| 778 | JsonInputStream str(data); | 
|---|
| 779 | str << bp; | 
|---|
| 780 | sendTcfTrkMessage(MessageWithReply, BreakpointsService, "add", data, callBack, cookie); | 
|---|
| 781 | } | 
|---|
| 782 |  | 
|---|
| 783 | void TcfTrkDevice::sendBreakpointsRemoveCommand(const TcfTrkCallback &callBack, | 
|---|
| 784 | const QByteArray &id, | 
|---|
| 785 | const QVariant &cookie) | 
|---|
| 786 | { | 
|---|
| 787 | sendBreakpointsRemoveCommand(callBack, QVector<QByteArray>(1, id), cookie); | 
|---|
| 788 | } | 
|---|
| 789 |  | 
|---|
| 790 | void TcfTrkDevice::sendBreakpointsRemoveCommand(const TcfTrkCallback &callBack, | 
|---|
| 791 | const QVector<QByteArray> &ids, | 
|---|
| 792 | const QVariant &cookie) | 
|---|
| 793 | { | 
|---|
| 794 | QByteArray data; | 
|---|
| 795 | JsonInputStream str(data); | 
|---|
| 796 | str << ids; | 
|---|
| 797 | sendTcfTrkMessage(MessageWithReply, BreakpointsService, "remove", data, callBack, cookie); | 
|---|
| 798 | } | 
|---|
| 799 |  | 
|---|
| 800 | void TcfTrkDevice::sendBreakpointsEnableCommand(const TcfTrkCallback &callBack, | 
|---|
| 801 | const QByteArray &id, | 
|---|
| 802 | bool enable, | 
|---|
| 803 | const QVariant &cookie) | 
|---|
| 804 | { | 
|---|
| 805 | sendBreakpointsEnableCommand(callBack, QVector<QByteArray>(1, id), enable, cookie); | 
|---|
| 806 | } | 
|---|
| 807 |  | 
|---|
| 808 | void TcfTrkDevice::sendBreakpointsEnableCommand(const TcfTrkCallback &callBack, | 
|---|
| 809 | const QVector<QByteArray> &ids, | 
|---|
| 810 | bool enable, | 
|---|
| 811 | const QVariant &cookie) | 
|---|
| 812 | { | 
|---|
| 813 | QByteArray data; | 
|---|
| 814 | JsonInputStream str(data); | 
|---|
| 815 | str << ids; | 
|---|
| 816 | sendTcfTrkMessage(MessageWithReply, BreakpointsService, | 
|---|
| 817 | enable ? "enable" : "disable", | 
|---|
| 818 | data, callBack, cookie); | 
|---|
| 819 | } | 
|---|
| 820 |  | 
|---|
| 821 | void TcfTrkDevice::sendMemorySetCommand(const TcfTrkCallback &callBack, | 
|---|
| 822 | const QByteArray &contextId, | 
|---|
| 823 | quint64 start, const QByteArray& data, | 
|---|
| 824 | const QVariant &cookie) | 
|---|
| 825 | { | 
|---|
| 826 | QByteArray getData; | 
|---|
| 827 | JsonInputStream str(getData); | 
|---|
| 828 | // start/word size/mode. Mode should ideally be 1 (continue on error?) | 
|---|
| 829 | str << contextId << '\0' << start << '\0' << 1 << '\0' << data.size() << '\0' << 1 | 
|---|
| 830 | << '\0' << data.toBase64(); | 
|---|
| 831 | sendTcfTrkMessage(MessageWithReply, MemoryService, "set", getData, callBack, cookie); | 
|---|
| 832 | } | 
|---|
| 833 |  | 
|---|
| 834 | void TcfTrkDevice::sendMemoryGetCommand(const TcfTrkCallback &callBack, | 
|---|
| 835 | const QByteArray &contextId, | 
|---|
| 836 | quint64 start, quint64 size, | 
|---|
| 837 | const QVariant &cookie) | 
|---|
| 838 | { | 
|---|
| 839 | QByteArray data; | 
|---|
| 840 | JsonInputStream str(data); | 
|---|
| 841 | // start/word size/mode. Mode should ideally be 1 (continue on error?) | 
|---|
| 842 | str << contextId << '\0' << start << '\0' << 1 << '\0' << size << '\0' << 1; | 
|---|
| 843 | sendTcfTrkMessage(MessageWithReply, MemoryService, "get", data, callBack, cookie); | 
|---|
| 844 | } | 
|---|
| 845 |  | 
|---|
| 846 | QByteArray TcfTrkDevice::parseMemoryGet(const TcfTrkCommandResult &r) | 
|---|
| 847 | { | 
|---|
| 848 | if (r.type != TcfTrkCommandResult::SuccessReply || r.values.size() < 1) | 
|---|
| 849 | return QByteArray(); | 
|---|
| 850 | const JsonValue &memoryV = r.values.front(); | 
|---|
| 851 |  | 
|---|
| 852 | if (memoryV.type() != JsonValue::String || memoryV.data().size() < 2 | 
|---|
| 853 | || !memoryV.data().endsWith('=')) | 
|---|
| 854 | return QByteArray(); | 
|---|
| 855 | // Catch errors reported as hash: | 
|---|
| 856 | // R.4."TlVMTA==".{"Time":1276786871255,"Code":1,"AltCode":-38,"AltOrg":"POSIX","Format":"BadDescriptor"} | 
|---|
| 857 | // Not sure what to make of it. | 
|---|
| 858 | if (r.values.size() >= 2 && r.values.at(1).type() == JsonValue::Object) | 
|---|
| 859 | qWarning("Error retrieving memory: %s", r.values.at(1).toString(false).constData()); | 
|---|
| 860 | // decode | 
|---|
| 861 | const QByteArray memory = QByteArray::fromBase64(memoryV.data()); | 
|---|
| 862 | if (memory.isEmpty()) | 
|---|
| 863 | qWarning("Base64 decoding of %s failed.", memoryV.data().constData()); | 
|---|
| 864 | if (debug) | 
|---|
| 865 | qDebug("TcfTrkDevice::parseMemoryGet: received %d bytes", memory.size()); | 
|---|
| 866 | return memory; | 
|---|
| 867 | } | 
|---|
| 868 |  | 
|---|
| 869 | void TcfTrkDevice::sendRegistersGetMCommand(const TcfTrkCallback &callBack, | 
|---|
| 870 | const QByteArray &contextId, | 
|---|
| 871 | const QVector<QByteArray> &ids, | 
|---|
| 872 | const QVariant &cookie) | 
|---|
| 873 | { | 
|---|
| 874 | // TODO: use "Registers" (which uses base64-encoded values) | 
|---|
| 875 | QByteArray data; | 
|---|
| 876 | JsonInputStream str(data); | 
|---|
| 877 | str << contextId << '\0' << ids; | 
|---|
| 878 | sendTcfTrkMessage(MessageWithReply, SimpleRegistersService, "get", data, callBack, cookie); | 
|---|
| 879 | } | 
|---|
| 880 |  | 
|---|
| 881 | void TcfTrkDevice::sendRegistersGetMRangeCommand(const TcfTrkCallback &callBack, | 
|---|
| 882 | const QByteArray &contextId, | 
|---|
| 883 | unsigned start, unsigned count) | 
|---|
| 884 | { | 
|---|
| 885 | const unsigned end = start + count; | 
|---|
| 886 | if (end > (unsigned)d->m_registerNames.size()) { | 
|---|
| 887 | qWarning("TcfTrkDevice: No register name set for index %u (size: %d).", end, d->m_registerNames.size()); | 
|---|
| 888 | return; | 
|---|
| 889 | } | 
|---|
| 890 |  | 
|---|
| 891 | QVector<QByteArray> ids; | 
|---|
| 892 | ids.reserve(count); | 
|---|
| 893 | for (unsigned i = start; i < end; i++) | 
|---|
| 894 | ids.push_back(d->m_registerNames.at(i)); | 
|---|
| 895 | sendRegistersGetMCommand(callBack, contextId, ids, QVariant(start)); | 
|---|
| 896 | } | 
|---|
| 897 |  | 
|---|
| 898 | // Set register | 
|---|
| 899 | void TcfTrkDevice::sendRegistersSetCommand(const TcfTrkCallback &callBack, | 
|---|
| 900 | const QByteArray &contextId, | 
|---|
| 901 | const QByteArray &id, | 
|---|
| 902 | unsigned value, | 
|---|
| 903 | const QVariant &cookie) | 
|---|
| 904 | { | 
|---|
| 905 | // TODO: use "Registers" (which uses base64-encoded values) | 
|---|
| 906 | QByteArray data; | 
|---|
| 907 | JsonInputStream str(data); | 
|---|
| 908 | str << contextId << '\0' << QVector<QByteArray>(1, id) | 
|---|
| 909 | << '\0' << QVector<QByteArray>(1, QByteArray::number(value, 16)); | 
|---|
| 910 | sendTcfTrkMessage(MessageWithReply, SimpleRegistersService, "set", data, callBack, cookie); | 
|---|
| 911 | } | 
|---|
| 912 |  | 
|---|
| 913 | // Set register | 
|---|
| 914 | void TcfTrkDevice::sendRegistersSetCommand(const TcfTrkCallback &callBack, | 
|---|
| 915 | const QByteArray &contextId, | 
|---|
| 916 | unsigned registerNumber, | 
|---|
| 917 | unsigned value, | 
|---|
| 918 | const QVariant &cookie) | 
|---|
| 919 | { | 
|---|
| 920 | if (registerNumber >= (unsigned)d->m_registerNames.size()) { | 
|---|
| 921 | qWarning("TcfTrkDevice: No register name set for index %u (size: %d).", registerNumber, d->m_registerNames.size()); | 
|---|
| 922 | return; | 
|---|
| 923 | } | 
|---|
| 924 | sendRegistersSetCommand(callBack, contextId, | 
|---|
| 925 | d->m_registerNames[registerNumber], | 
|---|
| 926 | value, cookie); | 
|---|
| 927 | } | 
|---|
| 928 |  | 
|---|
| 929 | } // namespace tcftrk | 
|---|