int main(void)
{
halInit();
chSysInit();
initLed();
setLeds( 7 );
initRead();
initWrite();
initI2c();
initUsb();
/*IWDGConfig cfg;
cfg.div = IWDG_DIV_256;
cfg.counter = (40000 / 256 / 2 );
iwdgInit();
iwdgStart( &IWDGD, &cfg );
iwdgReset( &IWDGD );*/
while (TRUE)
{
//iwdgReset( &IWDGD );
processShell();
chThdSleepMilliseconds( 250 );
}
return 0;
}
void NtuWriteInterface<T>::openNtuple( const std::string& name ) {
TDirectory* current = gDirectory;
file = ( dumpNtuple ? new TFile( name.c_str(), "CREATE" ) : 0 );
initWrite( file );
current->cd();
return;
}
/**
* Constructor to store an image, its properties, and poses.
*/
ImagePose::ImagePose(const imagePoseData* infoData_, const std::vector<unsigned char> imageData_){
errorStatus = 0;
infoData = *infoData_;
imageData = imageData_;
imagePath = mobots_common::store::getPathForID(infoData.id.sessionID, infoData.id.mobotID, infoData.id.imageID, '.' + infoData.image.encoding);
infoPath = mobots_common::store::getPathForID(infoData.id.sessionID, infoData.id.mobotID, infoData.id.imageID, ".info");
initWrite();
}
void writeToLogBlk (UINT32 const dataLpn, UINT32 const sectOffset, UINT32 const nSects)
{
//uart_print_level_1("2 ");
uart_print("writeToLogBlk dataLpn="); uart_print_int(dataLpn);
uart_print(", sect_offset="); uart_print_int(sectOffset);
uart_print(", num_sectors="); uart_print_int(nSects); uart_print("\r\n");
if ( sectOffset + nSects == SECTORS_PER_PAGE )
{
for (UINT32 bank=0; bank < NUM_BANKS; ++bank)
{
if(SWCtrl[bank].nextDataLpn == dataLpn)
{
uart_print("Found stripe continuation on bank "); uart_print_int(bank); uart_print("\r\n");
bank_ = bank;
appendPageToSWBlock (dataLpn, sectOffset, nSects);
return;
}
}
}
bank_ = chooseNewBank();
initWrite(dataLpn, sectOffset, nSects);
//if (!isNewWrite_)
//{
if (nSects_ != SECTORS_PER_PAGE)
{
//manageOldPartialPage();
syncWithWriteLimit();
writePartialPageOld();
}
else
{ // writing entire page, so write directly to
manageOldCompletePage();
writeCompletePage();
}
//}
//else
//{
//if (nSects_ != SECTORS_PER_PAGE)
//{
//syncWithWriteLimit();
//writePartialPageNew();
//}
//else
//{ // writing entire page, so write directly to
//writeCompletePage();
//}
//}
}
void overwriteToLogBlk (UINT32 const dataLpn, UINT32 const sectOffset, UINT32 const nSects)
{
uart_print("overwriteToLogBlk dataLpn="); uart_print_int(dataLpn);
uart_print(", sect_offset="); uart_print_int(sectOffset);
uart_print(", num_sectors="); uart_print_int(nSects); uart_print("\r\n");
initWrite(dataLpn, sectOffset, nSects);
if (nSects_ != SECTORS_PER_PAGE)
{
syncWithWriteLimit();
overwritePartialPageOld();
}
else
{
overwriteCompletePageOld();
}
}
NtuEDMWriteSteering<T>::NtuEDMWriteSteering( const edm::ParameterSet& ps ):
T( ps, this ) {
histName = ps.getUntrackedParameter<std::string>( "histName" );
initWrite();
}
