dsu3plugin.cpp
332 lines
| 11.3 KiB
| text/x-c
|
CppLexer
/ dsu3plugin / dsu3plugin.cpp
r0 | /*------------------------------------------------------------------------------ | |||
Jeandet Alexis
|
r4 | -- This file is a part of the SocExplorer Software | ||
Jeandet Alexis
|
r11 | -- Copyright (C) 2011, Plasma Physics Laboratory - CNRS | ||
r0 | -- | |||
-- This program is free software; you can redistribute it and/or modify | ||||
-- it under the terms of the GNU General Public License as published by | ||||
-- the Free Software Foundation; either version 3 of the License, or | ||||
-- (at your option) any later version. | ||||
-- | ||||
-- This program 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 General Public License for more details. | ||||
-- | ||||
-- You should have received a copy of the GNU General Public License | ||||
-- along with this program; if not, write to the Free Software | ||||
-- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||||
-------------------------------------------------------------------------------*/ | ||||
/*-- Author : Alexis Jeandet | ||||
-- Mail : alexis.jeandet@lpp.polytechnique.fr | ||||
----------------------------------------------------------------------------*/ | ||||
#include "dsu3plugin.h" | ||||
#include <QFileDialog> | ||||
#include <QDir> | ||||
#include <socexplorerengine.h> | ||||
r44 | ||||
struct acceptedMemctrlr_str | ||||
{ | ||||
r45 | int vid; | |||
int pid; | ||||
const char* name; | ||||
r44 | }; | |||
const struct acceptedMemctrlr_str acceptedMemctrlr[]= | ||||
{ | ||||
paul
|
r48 | {0x04,0x0f,"MCTRL"}, | ||
r44 | {0x01,0x51,"FTSRCTRL"}, | |||
{0x20,0x01,"SRCTRLE_0WS" }, | ||||
{0x20,0x02,"SRCTRLE_1WS" } | ||||
}; | ||||
paul
|
r48 | #define acceptedMemctrlrCnt 4 | ||
r44 | ||||
r0 | dsu3plugin::dsu3plugin(QWidget *parent):socexplorerplugin(parent,false) | |||
{ | ||||
r45 | this->UI = new dsu3pluginui(); | |||
this->setWidget((QWidget*)this->UI); | ||||
this->elfparserInst = new elfparser(); | ||||
r52 | // this->pyObject = new dsu3pluginPywrapper(this); | |||
// QObject::connect(((dsu3pluginPywrapper*)this->pyObject),SIGNAL(openFile(QString)),this,SLOT(openFile(QString))); | ||||
// QObject::connect(((dsu3pluginPywrapper*)this->pyObject),SIGNAL(loadFile()),this,SLOT(flashTarget())); | ||||
// QObject::connect(((dsu3pluginPywrapper*)this->pyObject),SIGNAL(run()),this,SLOT(run())); | ||||
// QObject::connect(((dsu3pluginPywrapper*)this->pyObject),SIGNAL(stop()),this,SLOT(stop())); | ||||
// QObject::connect(((dsu3pluginPywrapper*)this->pyObject),SIGNAL(cacheEnable()),this,SLOT(cacheEnable())); | ||||
// QObject::connect(((dsu3pluginPywrapper*)this->pyObject),SIGNAL(cacheDisable()),this,SLOT(cacheDisable())); | ||||
// QObject::connect(((dsu3pluginPywrapper*)this->pyObject),SIGNAL(setCacheEnable(bool)),this,SLOT(setCacheEnable(bool))); | ||||
r44 | ||||
r45 | connect(this->UI,SIGNAL(openFile()),this,SLOT(openFile())); | |||
connect(this->UI,SIGNAL(flashTarget()),this,SLOT(flashTarget())); | ||||
connect(this->UI,SIGNAL(run()),this,SLOT(toggleRun())); | ||||
connect(this,SIGNAL(updateInfo(elfparser*)),this->UI,SIGNAL(updateInfo(elfparser*))); | ||||
this->running = false; | ||||
r0 | } | |||
dsu3plugin::~dsu3plugin() | ||||
{ | ||||
} | ||||
void dsu3plugin::openFile() | ||||
{ | ||||
r45 | QString filename = QFileDialog::getOpenFileName(this,tr("Open elf File"), QDir::homePath(), tr("Elf Files (*)")); | |||
if(filename!="") | ||||
r0 | { | |||
r45 | this->openFile(filename); | |||
r0 | } | |||
} | ||||
void dsu3plugin::openFile(QString fileName) | ||||
{ | ||||
r45 | this->elfparserInst->setFilename(fileName); | |||
emit this->updateInfo(this->elfparserInst); | ||||
r0 | } | |||
bool dsu3plugin::configureTarget() | ||||
{ | ||||
r49 | int detectedMctrlr=-1; | |||
r45 | if(parent==NULL) | |||
return false; | ||||
unsigned int DSUBASEADDRESS = SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,0x01 , 0x004,0); | ||||
if(DSUBASEADDRESS == (unsigned int)-1) | ||||
DSUBASEADDRESS = 0x90000000; | ||||
unsigned int MCTRLBASEADDRESS =-1; | ||||
for(int i=0; i<acceptedMemctrlrCnt;i++) | ||||
r37 | { | |||
r45 | MCTRLBASEADDRESS = SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,acceptedMemctrlr[i].vid , acceptedMemctrlr[i].pid,0); | |||
if(MCTRLBASEADDRESS != (unsigned int)-1) | ||||
{ | ||||
SocExplorerEngine::message(this,QString("Found %1 @%2").arg(acceptedMemctrlr[i].name).arg(MCTRLBASEADDRESS,8,16),1); | ||||
r49 | detectedMctrlr=i; | |||
r45 | break; | |||
} | ||||
r44 | } | |||
r45 | if(MCTRLBASEADDRESS == (unsigned int)-1) | |||
r44 | { | |||
r45 | SocExplorerEngine::message(this,"Can't any compatible memory controller",1); | |||
return false; | ||||
r37 | } | |||
r0 | ||||
r44 | ||||
r45 | //Force a debug break | |||
WriteRegs(uIntlist()<<0x0000002f,(unsigned int)DSUBASEADDRESS); | ||||
WriteRegs(uIntlist()<<0x0000ffff,(unsigned int)DSUBASEADDRESS+0x20); | ||||
//Clear time tag counter | ||||
WriteRegs(uIntlist()<<0,(unsigned int)DSUBASEADDRESS+0x8); | ||||
r0 | ||||
r45 | //Clear ASR registers | |||
WriteRegs(uIntlist()<<0<<0<<0,(unsigned int)DSUBASEADDRESS+0x400040); | ||||
WriteRegs(uIntlist()<<0x2,(unsigned int)DSUBASEADDRESS+0x400024); | ||||
WriteRegs(uIntlist()<<0<<0<<0<<0<<0<<0<<0<<0,(unsigned int)DSUBASEADDRESS+0x400060); | ||||
WriteRegs(uIntlist()<<0,(unsigned int)DSUBASEADDRESS+0x48); | ||||
WriteRegs(uIntlist()<<0,(unsigned int)DSUBASEADDRESS+0x000004C); | ||||
WriteRegs(uIntlist()<<0,(unsigned int)DSUBASEADDRESS+0x400040); | ||||
r0 | ||||
r49 | // {0x04,0x0f,"MCTRL"}, | |||
// {0x01,0x51,"FTSRCTRL"}, | ||||
// {0x20,0x01,"SRCTRLE_0WS" }, | ||||
// {0x20,0x02,"SRCTRLE_1WS" } | ||||
if(QString(acceptedMemctrlr[detectedMctrlr].name)=="MCTRL" || QString(acceptedMemctrlr[detectedMctrlr].name)=="FTSRCTRL" ) | ||||
{ | ||||
WriteRegs(uIntlist()<<0x2FF<<0xE60<<0,(unsigned int)MCTRLBASEADDRESS); | ||||
} | ||||
if(QString(acceptedMemctrlr[detectedMctrlr].name)=="SRCTRLE_0WS" || QString(acceptedMemctrlr[detectedMctrlr].name)=="SRCTRLE_1WS" ) | ||||
{ | ||||
//let's perform a mem Wash | ||||
unsigned int val = ReadReg(MCTRLBASEADDRESS); | ||||
val |=1<<31; | ||||
WriteRegs(uIntlist()<<val,(unsigned int)MCTRLBASEADDRESS); | ||||
usleep(1000*1000); | ||||
} | ||||
r0 | ||||
r45 | WriteRegs(uIntlist()<<0<<0<<0<<0,(unsigned int)DSUBASEADDRESS+0x400060); | |||
WriteRegs(uIntlist()<<0x0000FFFF,(unsigned int)DSUBASEADDRESS+0x24); | ||||
r44 | ||||
r45 | memSet(DSUBASEADDRESS+0x300000,0,1567); | |||
WriteRegs(uIntlist()<<0<<0xF30000E0<<0x00000002<<0x40000000<<0x40000000<<0x40000004<<0x1000000,(unsigned int)DSUBASEADDRESS+0x400000); | ||||
WriteRegs(uIntlist()<<0<<0<<0<<0<<0<<0<<0x403ffff0<<0<<0<<0<<0<<0<<0<<0<<0<<0<<0<<0<<0<<0<<0<<0<<0<<0,(unsigned int)DSUBASEADDRESS+0x300020); | ||||
WriteRegs(uIntlist()<<0x000002EF,(unsigned int)DSUBASEADDRESS); | ||||
r0 | ||||
r45 | //Disable interrupts | |||
unsigned int APBIRQCTRLRBASEADD = (unsigned int)SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,1,0x0d,0); | ||||
if(APBIRQCTRLRBASEADD == (unsigned int)-1) | ||||
return false; | ||||
WriteRegs(uIntlist()<<0x00000000,APBIRQCTRLRBASEADD+0x040); | ||||
WriteRegs(uIntlist()<<0xFFFE0000,APBIRQCTRLRBASEADD+0x080); | ||||
WriteRegs(uIntlist()<<0<<0,APBIRQCTRLRBASEADD); | ||||
r44 | ||||
r45 | //Set up timer | |||
unsigned int APBTIMERBASEADD = (unsigned int)SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,1,0x11,0); | ||||
if(APBTIMERBASEADD == (unsigned int)-1) | ||||
return false; | ||||
WriteRegs(uIntlist()<<0xffffffff,APBTIMERBASEADD+0x014); | ||||
WriteRegs(uIntlist()<<0x00000018,APBTIMERBASEADD+0x04); | ||||
WriteRegs(uIntlist()<<0x00000007,APBTIMERBASEADD+0x018); | ||||
return true; | ||||
r44 | } | |||
r0 | ||||
r44 | bool dsu3plugin::cacheDisable() | |||
{ | ||||
r45 | return setCacheEnable(false); | |||
r44 | } | |||
bool dsu3plugin::cacheEnable() | ||||
{ | ||||
r45 | return setCacheEnable(true); | |||
r44 | } | |||
r0 | ||||
r44 | bool dsu3plugin::setCacheEnable(bool enabled) | |||
{ | ||||
r45 | if(parent==NULL) | |||
return false; | ||||
unsigned int DSUBASEADDRESS = SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,0x01 , 0x004,0); | ||||
if(DSUBASEADDRESS == (unsigned int)-1) | ||||
DSUBASEADDRESS = 0x90000000; | ||||
WriteRegs(uIntlist()<<2,DSUBASEADDRESS+0x400024); | ||||
unsigned int reg = ReadReg(DSUBASEADDRESS+0x700000); | ||||
if(enabled) | ||||
r44 | { | |||
r45 | WriteRegs(uIntlist()<<(0x0001000F|reg),DSUBASEADDRESS+0x700000); | |||
//flushes cache. | ||||
WriteRegs(uIntlist()<<(0x0061000F|reg),DSUBASEADDRESS+0x700000); | ||||
r44 | } | |||
r45 | else | |||
r44 | { | |||
r45 | WriteRegs(uIntlist()<<((!0x0001000F)®),DSUBASEADDRESS+0x700000); | |||
WriteRegs(uIntlist()<<(0x00600000|reg),DSUBASEADDRESS+0x700000); | ||||
r44 | } | |||
r45 | return true; | |||
r0 | } | |||
bool dsu3plugin::flashTarget() | ||||
{ | ||||
r45 | stop(); | |||
cacheDisable(); | ||||
configureTarget(); | ||||
/*Write .text*/ | ||||
this->writeSection(".text"); | ||||
/*Write .data*/ | ||||
this->writeSection(".data"); | ||||
return true; | ||||
r0 | } | |||
void dsu3plugin::run() | ||||
{ | ||||
r45 | unsigned int DSUBASEADDRESS = SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,0x01 , 0x004,0); | |||
if(DSUBASEADDRESS == (unsigned int)-1) | ||||
DSUBASEADDRESS = 0x90000000; | ||||
WriteRegs(uIntlist()<<0,DSUBASEADDRESS+0x020); | ||||
this->running = true; | ||||
this->UI->setRunning(true); | ||||
r14 | } | |||
void dsu3plugin::stop() | ||||
{ | ||||
r45 | unsigned int DSUBASEADDRESS = SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,0x01 , 0x004,0); | |||
if(DSUBASEADDRESS == (unsigned int)-1) | ||||
DSUBASEADDRESS = 0x90000000; | ||||
WriteRegs(uIntlist()<<0xFFFF,DSUBASEADDRESS+0x020); | ||||
this->running = false; | ||||
this->UI->setRunning(false); | ||||
r14 | } | |||
void dsu3plugin::toggleRun() | ||||
{ | ||||
r45 | if(this->running) | |||
this->stop(); | ||||
else | ||||
this->run(); | ||||
r0 | } | |||
void dsu3plugin::WriteRegs(uIntlist Values, unsigned int address) | ||||
{ | ||||
r45 | unsigned int* buff; | |||
buff = (unsigned int*)malloc(Values.count()*sizeof(unsigned int)); | ||||
for(int i=0;i<Values.count();i++) | ||||
r0 | { | |||
r45 | buff[i]=Values.at(i); | |||
r0 | } | |||
r45 | parent->Write(buff,(unsigned int)Values.count(),address); | |||
free(buff); | ||||
} | ||||
unsigned int dsu3plugin::ReadReg(unsigned int address) | ||||
{ | ||||
unsigned int buff; | ||||
parent->Read(&buff,1,address); | ||||
return buff; | ||||
r0 | } | |||
void dsu3plugin::writeSection(int index) | ||||
{ | ||||
r45 | char* buffch=NULL; | |||
unsigned int* buff; | ||||
int size = this->elfparserInst->getSectionDatasz(index); | ||||
int sizeInt = size/4; | ||||
if(parent==NULL) | ||||
return; | ||||
this->elfparserInst->getSectionData(index,&buffch); | ||||
buff = (unsigned int*)malloc(((size/4)+1)*sizeof(unsigned int)); | ||||
for(int i=0;i<sizeInt;i++) | ||||
r0 | { | |||
r45 | buff[i] = 0x0FF & ((unsigned int)buffch[4*i]); | |||
buff[i] = (buff[i]<<8) + (0x0FF & ((unsigned int)buffch[(4*i)+1])); | ||||
buff[i] = (buff[i]<<8) + (0x0FF & ((unsigned int)buffch[(4*i)+2])); | ||||
buff[i] = (buff[i]<<8) + (0x0FF & ((unsigned int)buffch[(4*i)+3])); | ||||
r0 | } | |||
r45 | if(size%4) | |||
r0 | { | |||
r45 | buff[sizeInt]=0; | |||
for(int i=(size%4);i>0;i--) | ||||
r0 | { | |||
r45 | buff[sizeInt] = (buff[sizeInt]<<8) + (0x0FF & ((unsigned int)buffch[size-i])); | |||
r0 | } | |||
r45 | sizeInt++; | |||
r0 | } | |||
r45 | parent->Write(buff,(unsigned int)sizeInt,(unsigned int)this->elfparserInst->getSectionPaddr(index)); | |||
free(buff); | ||||
r0 | } | |||
void dsu3plugin::writeSection(const QString &name) | ||||
{ | ||||
r45 | for(int i=0;i<this->elfparserInst->getSectioncount();i++) | |||
r0 | { | |||
r45 | if(!this->elfparserInst->getSectionName(i).compare(name)) | |||
r0 | { | |||
r45 | printf("about to write section %s @ 0x%x size = %d\n",elfparserInst->getSectionName(i).toStdString().c_str(),elfparserInst->getSectionPaddr(i),elfparserInst->getSectionMemsz(i)); | |||
writeSection(i); | ||||
r0 | } | |||
} | ||||
} | ||||
unsigned int dsu3plugin::Write(unsigned int *Value,unsigned int count,unsigned int address) | ||||
{ | ||||
r45 | if(parent!=NULL) | |||
return parent->Write(Value,count,address); | ||||
return 0; | ||||
r0 | } | |||
bool dsu3plugin::memSet(unsigned int address,int value, unsigned int count) | ||||
{ | ||||
r45 | unsigned int* buffer = (unsigned int*)malloc(count*sizeof(unsigned int)); | |||
if(buffer!=NULL) | ||||
r0 | { | |||
r45 | memset((void*)buffer,value,count*sizeof(unsigned int)); | |||
parent->Write(buffer,count,address); | ||||
free(buffer ); | ||||
return true; | ||||
r0 | } | |||
r45 | return false; | |||
r0 | } | |||
unsigned int dsu3plugin::Read(unsigned int *Value,unsigned int count, unsigned int address) | ||||
{ | ||||
r45 | if(parent!=NULL) | |||
return parent->Read(Value,count,address); | ||||
return 0; | ||||
r0 | } | |||