feedc0de/qt-creator
1
0
Fork 0
forked from qt-creator/qt-creator
Code Pull Requests Activity
Files
b901b5013d66212535de5fec88387e9a6f60bad6
qt-creator/tests/manual/trk/trkserver.cpp
Friedemann Kleint fdf6120d17 Trk: Add device class.
2009-08-20 15:58:20 +02:00

514 lines
15 KiB
C++
Raw Blame History

/**************************************************************************
**
** This file is part of Qt Creator
**
** Copyright (c) 2009 Nokia Corporation and/or its subsidiary(-ies).
**
** Contact: Nokia Corporation (qt-info@nokia.com)
**
** Commercial Usage
**
** Licensees holding valid Qt Commercial licenses may use this file in
** accordance with the Qt Commercial License Agreement provided with the
** Software or, alternatively, in accordance with the terms contained in
** a written agreement between you and Nokia.
**
** GNU Lesser General Public License Usage
**
** Alternatively, this file may be used under the terms of the GNU Lesser
** General Public License version 2.1 as published by the Free Software
** Foundation and appearing in the file LICENSE.LGPL included in the
** packaging of this file. Please review the following information to
** ensure the GNU Lesser General Public License version 2.1 requirements
** will be met: http://www.gnu.org/licenses/old-licenses/lgpl-2.1.html.
**
** If you are unsure which license is appropriate for your use, please
** contact the sales department at http://qt.nokia.com/contact.
**
**************************************************************************/
#include "trkutils.h"
#include <QtCore/QCoreApplication>
#include <QtCore/QFile>
#include <QtCore/QStringList>
#include <QtCore/QFileInfo>
#include <QtNetwork/QLocalServer>
#include <QtNetwork/QLocalSocket>
#ifdef Q_OS_UNIX
#include <signal.h>
void signalHandler(int)
{
qApp->exit(1);
}
#endif
using namespace trk;
struct TrkOptions {
TrkOptions() : verbose(1), serialFrame(true) {}
int verbose;
bool serialFrame;
QString serverName;
QString dumpName;
QStringList additionalDumps;
};
// Format of the replay source is something like
// ---IDE------------------------------------------------------
// Command: 0x05 Support Mask
// [05 02]
//---TRK------------------------------------------------------
// Command: 0x80 Acknowledge
// Error: 0x0
// [80 02 00 7E 00 4F 5F 01 00 00 00 0F 1F 00 00 00
// 00 00 00 01 00 11 00 03 00 00 00 00 00 03 00 00...]
struct MemorySegment {
MemorySegment(const QString &n = QString()) : name(n), address(0) {}
bool readDump(const QString &fileName, uint address /* = 0*/, QString *errorMessage);
bool readMemory(uint addr, ushort len, QByteArray *ba) const;
QString name;
uint address;
QByteArray data;
};
// Determine address from filename using the "0xa5453.bin" convention
static int addressFromFileName(const QString &fn)
{
QString baseName = QFileInfo(fn).fileName();
if (!baseName.startsWith(QLatin1String("0x")))
return -1;
baseName.remove(0, 2);
int sepPos = baseName.indexOf(QLatin1Char('_'));
if (sepPos == -1)
sepPos = baseName.indexOf(QLatin1Char('-'));
if (sepPos == -1)
sepPos = baseName.indexOf(QLatin1Char('.'));
if (sepPos == -1)
return -1;
baseName.truncate(sepPos);
bool ok;
const int value = baseName.toInt(&ok, 16);
return ok ? value : -1;
}
// Read a chunk of memory from file. Use address unless it is 0,
// in which case the filename is used for matching "0xa5453.bin"
bool MemorySegment::readDump(const QString &fileName, uint addressIn /* = 0*/, QString *errorMessage)
{
QFile file(fileName);
if (!file.open(QIODevice::ReadOnly)) {
*errorMessage = QString::fromLatin1("Unable to read %1: %2").arg(fileName, file.errorString());
return false;
}
data = file.readAll();
file.close();
if (addressIn) {
address = addressIn;
} else {
const int addressInt = addressFromFileName(fileName);
if (addressInt == -1) {
*errorMessage = QString::fromLatin1("Unable to determine address from %1").arg(fileName);
return false;
}
address = addressInt;
}
*errorMessage = QString::fromLatin1("Read %1 bytes of data starting at 0x%2 from %3").arg(data.size()).arg(address, 0, 16).arg(fileName);
return true;
}
bool MemorySegment::readMemory(uint addr, ushort len, QByteArray *ba) const
{
if (addr < address)
return false;
const int requestStart = addr - address;
const int requestEnd = requestStart + len;
if (requestEnd > data.size())
return false;
for (int i = requestStart; i != requestEnd; ++i)
appendByte(ba, data.at(i));
return true;
}
struct Inferior
{
Inferior();
uint pid;
uint tid;
uint codeseg;
uint dataseg;
uint registers[RegisterCount];
QList<MemorySegment> memorySegments;
};
Inferior::Inferior()
{
pid = 0x000008F5;
tid = 0x000008F6;
codeseg = 0x786A4000;
dataseg = 0x00400000;
registers[0] = 0x00000000;
registers[1] = 0xC92D7FBC;
registers[2] = 0x00000000;
registers[3] = 0x00600000;
registers[4] = 0x00000000;
registers[5] = 0x786A7970;
registers[6] = 0x00000000;
registers[7] = 0x00000000;
registers[8] = 0x00000012;
registers[9] = 0x00000040;
registers[10] = 0xC82AF210;
registers[11] = 0x00000000;
registers[12] = 0xC8000548;
registers[13] = 0x00403ED0;
registers[14] = 0x786A6BD8;
registers[15] = 0x786A4CC8;
registers[16] = 0x68000010; // that's reg 25 on chip?
}
class TrkServer : public QObject
{
Q_OBJECT
public:
TrkServer();
~TrkServer();
void setServerName(const QString &name) { m_serverName = name; }
void setMemoryDumpName(const QString &source) { m_memoryDumpName = source; }
void setVerbose(int v) { m_verbose = v; }
void setSerialFrame(bool b) { m_serialFrame = b; }
bool readDump(const QString &fn);
bool startServer();
private slots:
void handleConnection();
void readFromAdapter();
void writeToAdapter(byte command, byte token, const QByteArray &data);
void handleAdapterMessage(const TrkResult &result);
private:
void logMessage(const QString &msg, bool force = 0) const;
bool handleMemoryRequest(uint addr, ushort len, byte option, QByteArray *ba) const;
byte nextNotificationToken();
QString m_serverName;
QString m_memoryDumpName;
QByteArray m_adapterReadBuffer;
QByteArray m_memoryData;
QLocalServer m_server;
int m_lastSent;
QLocalSocket *m_adapterConnection;
Inferior m_inferior;
byte m_notificationToken;
int m_verbose;
bool m_serialFrame;
};
TrkServer::TrkServer() :
m_adapterConnection(0),
m_notificationToken(0),
m_verbose(1),
m_serialFrame(true)
{
}
TrkServer::~TrkServer()
{
logMessage("Shutting down.\n");
m_server.close();
}
bool TrkServer::readDump(const QString &fn)
{
QString msg;
MemorySegment segment(QLatin1String("data"));
if (!segment.readDump(fn, 0, &msg)) {
logMessage(msg, true);
return false;
}
m_inferior.memorySegments.push_back(segment);
logMessage(msg, true);
return true;
}
bool TrkServer::startServer()
{
QString msg;
MemorySegment codeSegment(QLatin1String("code"));
if (!codeSegment.readDump(m_memoryDumpName, 0x786A4000, &msg)) {
logMessage(msg, true);
return false;
}
m_inferior.memorySegments.push_front(codeSegment);
logMessage(msg, true);
m_lastSent = 0;
if (!m_server.listen(m_serverName)) {
logMessage(QString("Error: Unable to start the TRK server %1: %2.")
.arg(m_serverName).arg(m_server.errorString()), true);
return false;
}
logMessage("The TRK server '" + m_serverName + "'is running. Run the adapter now.", true);
connect(&m_server, SIGNAL(newConnection()), this, SLOT(handleConnection()));
return true;
}
void TrkServer::logMessage(const QString &msg, bool force) const
{
if (m_verbose || force)
qDebug("TRKSERVER: %s", qPrintable(msg));
}
void TrkServer::handleConnection()
{
m_adapterConnection = m_server.nextPendingConnection();
connect(m_adapterConnection, SIGNAL(disconnected()),
m_adapterConnection, SLOT(deleteLater()));
connect(m_adapterConnection, SIGNAL(readyRead()),
this, SLOT(readFromAdapter()));
}
void TrkServer::readFromAdapter()
{
QByteArray packet = m_adapterConnection->readAll();
m_adapterReadBuffer.append(packet);
logMessage("trk: -> " + stringFromArray(packet));
if (packet != m_adapterReadBuffer)
logMessage("buffer: " + stringFromArray(m_adapterReadBuffer));
while (!m_adapterReadBuffer.isEmpty()) {
TrkResult r;
while (extractResult(&m_adapterReadBuffer, m_serialFrame, &r))
handleAdapterMessage(r);
}
}
void TrkServer::writeToAdapter(byte command, byte token, const QByteArray &data)
{
QByteArray msg = frameMessage(command, token, data, m_serialFrame);
logMessage("trk: <- " + stringFromArray(msg));
m_adapterConnection->write(msg);
}
bool TrkServer::handleMemoryRequest(uint addr, ushort len, byte option, QByteArray *ba) const
{
Q_UNUSED(option);
foreach (const MemorySegment &s, m_inferior.memorySegments) {
if (s.readMemory(addr, len, ba)) {
if (m_verbose)
logMessage(QString::fromLatin1("Read memory %1 bytes from 0x%2 from segment %3.").arg(len).arg(addr, 0, 16).arg(s.name));
return true;
}
}
logMessage(QString::fromLatin1("ADDRESS OUTSIDE ANY SEGMENTS: 0X%1").arg(addr, 0, 16), true);
return false;
}
void TrkServer::handleAdapterMessage(const TrkResult &result)
{
QByteArray data;
data.append(char(0x00)); // No error
switch (result.code) {
case 0x00: { // Ping
m_notificationToken = 0;
writeToAdapter(0x80, 0x00, data);
break;
}
case 0x01: { // Connect
writeToAdapter(0x80, result.token, data);
break;
}
case 0x10: { // Read Memory
const char *p = result.data.data();
byte option = p[0];
Q_UNUSED(option);
const ushort len = extractShort(p + 1);
const uint addr = extractInt(p + 3);;
if (handleMemoryRequest(addr, len, option, &data)) {
writeToAdapter(0x80, result.token, data);
} else {
data[0] = 32; // NAK, bad hair day
writeToAdapter(0x80, result.token, data);
}
break;
}
case 0x12: { // Read Registers
for (int i = 0; i < RegisterCount; ++i)
appendInt(&data, m_inferior.registers[i], BigEndian);
writeToAdapter(0x80, result.token, data);
break;
}
case 0x18: { // Continue
writeToAdapter(0x80, result.token, data); // ACK Package
if (1) { // Fake "Stop"
QByteArray note;
appendInt(&note, 0); // FIXME: use proper address
appendInt(&note, m_inferior.pid);
appendInt(&note, m_inferior.tid);
appendByte(&note, 0x00);
appendByte(&note, 0x00);
writeToAdapter(0x90, nextNotificationToken(), note);
}
break;
}
case 0x19: { // Step
const char *p = result.data.data();
//byte option = *p;
uint startaddr = extractInt(p + 1);
uint endaddr = extractInt(p + 5);
uint pid = extractInt(p + 9);
//uint tid = extractInt(p + 13);
if (startaddr != m_inferior.registers[RegisterPC])
logMessage("addr mismatch:" + hexNumber(startaddr) + " " +
hexNumber(m_inferior.registers[RegisterPC]));
if (pid != m_inferior.pid)
logMessage("pid mismatch:" + hexNumber(pid) + " " +
hexNumber(m_inferior.pid));
writeToAdapter(0x80, result.token, data);
// Fake "step"
m_inferior.registers[RegisterPC] = endaddr;
if (1) { // Fake "Stop"
QByteArray note;
appendInt(&note, 0); // FIXME: use proper address
appendInt(&note, m_inferior.pid);
appendInt(&note, m_inferior.tid);
appendByte(&note, 0x00);
appendByte(&note, 0x00);
writeToAdapter(0x90, nextNotificationToken(), note);
}
break;
}
case 0x40: { // Create Item
appendInt(&data, m_inferior.pid, BigEndian);
appendInt(&data, m_inferior.tid, BigEndian);
appendInt(&data, m_inferior.codeseg, BigEndian);
appendInt(&data, m_inferior.dataseg, BigEndian);
writeToAdapter(0x80, result.token, data);
break;
}
case 0x41: { // Delete Item
writeToAdapter(0x80, result.token, data);
// A Process?
// Command: 0xA1 Notify Deleted
//[A1 02 00 00 00 00 00 00 00 00 01 B5]
QByteArray note; // FIXME
appendByte(&note, 0);
appendByte(&note, 0);
appendInt(&note, 0);
appendInt(&note, m_inferior.pid);
writeToAdapter(0xA1, nextNotificationToken(), note);
break;
}
case 0x1B: { // Set Break
static int breakpointNumber = 10; // Trk does that
appendInt(&data, breakpointNumber++);
writeToAdapter(0x80, result.token, data);
break;
}
default: {
data[0] = 0x10; // Command not supported
writeToAdapter(0xff, result.token, data);
break;
}
}
}
byte TrkServer::nextNotificationToken()
{
++m_notificationToken;
if (m_notificationToken == 0)
++m_notificationToken;
return m_notificationToken;
}
static bool readTrkArgs(const QStringList &args, TrkOptions *o)
{
int argNumber = 0;
const QStringList::const_iterator cend = args.constEnd();
QStringList::const_iterator it = args.constBegin();
for (++it; it != cend; ++it) {
if (it->startsWith(QLatin1Char('-'))) {
if (*it == QLatin1String("-v")) {
o->verbose++;
} else if (*it == QLatin1String("-q")) {
o->verbose = 0;
} else if (*it == QLatin1String("-f")) {
o->serialFrame= false;
}
} else {
switch (argNumber++) {
case 0:
o->serverName = *it;
break;
case 1:
o->dumpName = *it;
break;
default:
o->additionalDumps.push_back(*it);
break;
}
}
}
return !o->dumpName.isEmpty();
}
int main(int argc, char *argv[])
{
#ifdef Q_OS_UNIX
signal(SIGUSR1, signalHandler);
#endif
QCoreApplication app(argc, argv);
TrkOptions options;
if (!readTrkArgs(app.arguments(), &options)) {
qWarning("Usage: %s [-v|-q] <trkservername> <replaysource> [additional dumps]\n"
"Options: -v verbose\n"
" -f Turn serial message frame off\n"
" -q quiet\n"
" Additional dump names must follow the naming convention '0x4AD.bin", argv[0]);
return 1;
}
TrkServer server;
server.setServerName(options.serverName);
server.setMemoryDumpName(options.dumpName);
server.setSerialFrame(options.serialFrame);
foreach(const QString &ad, options.additionalDumps)
if (!server.readDump(ad))
return -1;
server.setVerbose(options.verbose);
if (!server.startServer())
return -1;
return app.exec();
}
#include "trkserver.moc"
View Git Blame Copy Permalink