dsu3plugin.cpp
225 lines
| 8.1 KiB
| text/x-c
|
CppLexer
/ dsu3plugin / dsu3plugin.cpp
r0 | /*------------------------------------------------------------------------------ | |||
|
r4 | -- This file is a part of the SocExplorer Software | ||
|
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 "dsu3pluginpywrapper.h" | ||||
#include <socexplorerengine.h> | ||||
dsu3plugin::dsu3plugin(QWidget *parent):socexplorerplugin(parent,false) | ||||
{ | ||||
this->UI = new dsu3pluginui(); | ||||
this->setWidget((QWidget*)this->UI); | ||||
this->elfparserInst = new elfparser(); | ||||
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())); | ||||
connect(this->UI,SIGNAL(openFile()),this,SLOT(openFile())); | ||||
connect(this->UI,SIGNAL(flashTarget()),this,SLOT(flashTarget())); | ||||
connect(this->UI,SIGNAL(run()),this,SLOT(run())); | ||||
connect(this,SIGNAL(updateInfo(elfparser*)),this->UI,SIGNAL(updateInfo(elfparser*))); | ||||
} | ||||
dsu3plugin::~dsu3plugin() | ||||
{ | ||||
} | ||||
void dsu3plugin::openFile() | ||||
{ | ||||
QString filename = QFileDialog::getOpenFileName(this,tr("Open elf File"), QDir::homePath(), tr("Elf Files (*)")); | ||||
if(filename!="") | ||||
{ | ||||
this->openFile(filename); | ||||
} | ||||
} | ||||
void dsu3plugin::openFile(QString fileName) | ||||
{ | ||||
this->elfparserInst->setFilename(fileName); | ||||
emit this->updateInfo(this->elfparserInst); | ||||
} | ||||
bool dsu3plugin::configureTarget() | ||||
{ | ||||
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 = SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,0x04 , 0x00F,0); | ||||
if(MCTRLBASEADDRESS == (unsigned int)-1) | ||||
return false; | ||||
//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); | ||||
//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); | ||||
WriteRegs(uIntlist()<<0x2FF<<0xE60<<0,(unsigned int)MCTRLBASEADDRESS); | ||||
WriteRegs(uIntlist()<<0<<0<<0<<0,(unsigned int)DSUBASEADDRESS+0x400060); | ||||
WriteRegs(uIntlist()<<0x0000FFFF,(unsigned int)DSUBASEADDRESS+0x24); | ||||
unsigned int buff=0; | ||||
// for(int i=0;i<1567;i++) | ||||
// { | ||||
// parent->Write(&buff,(unsigned int)1,DSUBASEADDRESS+0x300000+(4*i)); | ||||
// } | ||||
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); | ||||
//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); | ||||
//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; | ||||
} | ||||
bool dsu3plugin::flashTarget() | ||||
{ | ||||
configureTarget(); | ||||
/*Write .text*/ | ||||
this->writeSection(".text"); | ||||
/*Write .data*/ | ||||
this->writeSection(".data"); | ||||
return true; | ||||
} | ||||
void dsu3plugin::run() | ||||
{ | ||||
unsigned int DSUBASEADDRESS = SocExplorerEngine::self()->getEnumDeviceBaseAddress(this,0x01 , 0x004,0); | ||||
if(DSUBASEADDRESS == (unsigned int)-1) | ||||
DSUBASEADDRESS = 0x90000000; | ||||
WriteRegs(uIntlist()<<0,DSUBASEADDRESS+0x020); | ||||
} | ||||
void dsu3plugin::WriteRegs(uIntlist Values, unsigned int address) | ||||
{ | ||||
unsigned int* buff; | ||||
buff = (unsigned int*)malloc(Values.count()*sizeof(unsigned int)); | ||||
for(int i=0;i<Values.count();i++) | ||||
{ | ||||
buff[i]=Values.at(i); | ||||
} | ||||
parent->Write(buff,(unsigned int)Values.count(),address); | ||||
free(buff); | ||||
} | ||||
void dsu3plugin::writeSection(int index) | ||||
{ | ||||
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++) | ||||
{ | ||||
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])); | ||||
} | ||||
if(size%4) | ||||
{ | ||||
buff[sizeInt]=0; | ||||
for(int i=(size%4);i>0;i--) | ||||
{ | ||||
buff[sizeInt] = (buff[sizeInt]<<8) + (0x0FF & ((unsigned int)buffch[size-i])); | ||||
} | ||||
sizeInt++; | ||||
} | ||||
parent->Write(buff,(unsigned int)sizeInt,(unsigned int)this->elfparserInst->getSectionPaddr(index)); | ||||
free(buff); | ||||
} | ||||
void dsu3plugin::writeSection(const QString &name) | ||||
{ | ||||
for(int i=0;i<this->elfparserInst->getSectioncount();i++) | ||||
{ | ||||
if(!this->elfparserInst->getSectionName(i).compare(name)) | ||||
{ | ||||
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); | ||||
} | ||||
} | ||||
} | ||||
unsigned int dsu3plugin::Write(unsigned int *Value,unsigned int count,unsigned int address) | ||||
{ | ||||
if(parent!=NULL) | ||||
return parent->Write(Value,count,address); | ||||
return 0; | ||||
} | ||||
bool dsu3plugin::memSet(unsigned int address,int value, unsigned int count) | ||||
{ | ||||
unsigned int* buffer = (unsigned int*)malloc(count*sizeof(unsigned int)); | ||||
if(buffer!=NULL) | ||||
{ | ||||
memset((void*)buffer,value,count*sizeof(unsigned int)); | ||||
parent->Write(buffer,count,address); | ||||
free(buffer ); | ||||
return true; | ||||
} | ||||
return false; | ||||
} | ||||
unsigned int dsu3plugin::Read(unsigned int *Value,unsigned int count, unsigned int address) | ||||
{ | ||||
if(parent!=NULL) | ||||
return parent->Read(Value,count,address); | ||||
return 0; | ||||
} | ||||