HG_REPOSITORIES/LPP/INSTRUMENTATION/SocExplorerPlugins Commit - r69:039eabb0d39f

1

/*------------------------------------------------------------------------------

1

/*------------------------------------------------------------------------------

2

-- This file is a part of the SocExplorer Software

2

-- This file is a part of the SocExplorer Software

3

4

--

4

--

5

-- This program is free software; you can redistribute it and/or modify

5

-- This program is free software; you can redistribute it and/or modify

6

-- it under the terms of the GNU General Public License as published by

6

-- it under the terms of the GNU General Public License as published by

7

-- the Free Software Foundation; either version 3 of the License, or

7

-- the Free Software Foundation; either version 3 of the License, or

8

-- (at your option) any later version.

8

-- (at your option) any later version.

9

--

9

--

10

-- This program is distributed in the hope that it will be useful,

10

-- This program is distributed in the hope that it will be useful,

11

-- but WITHOUT ANY WARRANTY; without even the implied warranty of

11

-- but WITHOUT ANY WARRANTY; without even the implied warranty of

12

-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the

12

-- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the

13

-- GNU General Public License for more details.

13

-- GNU General Public License for more details.

14

--

14

--

15

-- You should have received a copy of the GNU General Public License

15

-- You should have received a copy of the GNU General Public License

16

-- along with this program; if not, write to the Free Software

16

-- along with this program; if not, write to the Free Software

17

-- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA

17

-- Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA

18

-------------------------------------------------------------------------------*/

18

-------------------------------------------------------------------------------*/

19

/*-- Author : Alexis Jeandet

19

/*-- Author : Alexis Jeandet

20

-- Mail : alexis.jeandet@member.fsf.org

20

-- Mail : alexis.jeandet@member.fsf.org

21

----------------------------------------------------------------------------*/

21

----------------------------------------------------------------------------*/

22

23

#include "stardundeespw_usb.h"

23

#include "stardundeespw_usb.h"

24

#include "fakestardundeespwusb_lib.h"

24

#include "fakestardundeespwusb_lib.h"

25

#include <socexplorerengine.h>

25

#include <socexplorerengine.h>

26

#include <qhexedit.h>

26

#include <qhexedit.h>

27

28

QString dwLinkStatusQString[6] = {

28

QString dwLinkStatusQString[6] = {

29

"CFG_SPACEWIRE_ERROR_RESET",

29

"CFG_SPACEWIRE_ERROR_RESET",

30

"CFG_SPACEWIRE_ERROR_WAIT",

30

"CFG_SPACEWIRE_ERROR_WAIT",

31

"CFG_SPACEWIRE_READY",

31

"CFG_SPACEWIRE_READY",

32

"CFG_SPACEWIRE_STARTED",

32

"CFG_SPACEWIRE_STARTED",

33

"CFG_SPACEWIRE_CONNECTING",

33

"CFG_SPACEWIRE_CONNECTING",

34

"CFG_SPACEWIRE_RUN"

34

"CFG_SPACEWIRE_RUN"

35

};

35

};

36

37

stardundeeSPW_USB::stardundeeSPW_USB(socexplorerplugin *parent) :

37

stardundeeSPW_USB::stardundeeSPW_USB(socexplorerplugin *parent) :

38

abstractSpwBridge(parent)

38

abstractSpwBridge(parent)

39

{

39

{

40

Q_UNUSED(parent)

40

Q_UNUSED(parent)

41

this->manager = new stardundeeSPW_USB_Manager(parent,this);

41

this->manager = new stardundeeSPW_USB_Manager(parent,this);

42

makeGUI(parent);

42

makeGUI(parent);

43

this->manager->start();

43

this->manager->start();

44

connect(this->manager,SIGNAL(emitPacket(char*,int)),this,SIGNAL(pushPacketOverTCP(char*,int)));

44

connect(this->manager,SIGNAL(emitPacket(char*,int)),this,SIGNAL(pushPacketOverTCP(char*,int)));

45

connect(this->manager, SIGNAL(bytesReceivedFromSpw(uint)), this, SIGNAL(BytesReceivedFromSpw(uint)));

45

connect(this->manager, SIGNAL(bytesReceivedFromSpw(uint)), this, SIGNAL(BytesReceivedFromSpw(uint)));

46

connect(this->manager, SIGNAL(bytesTransmittedToSpw(uint)), this, SIGNAL(BytesTransmittedToSpw(uint)));

46

connect(this->manager, SIGNAL(bytesTransmittedToSpw(uint)), this, SIGNAL(BytesTransmittedToSpw(uint)));

47

connect(this->manager, SIGNAL(ccsdsPacketTransmittedToSpw()), this, SIGNAL(CCSDSPacketTransmittedToSpw()));

47

connect(this->manager, SIGNAL(ccsdsPacketTransmittedToSpw()), this, SIGNAL(CCSDSPacketTransmittedToSpw()));

48

}

48

}

49

50

stardundeeSPW_USB::~stardundeeSPW_USB()

50

stardundeeSPW_USB::~stardundeeSPW_USB()

51

{

51

{

52

this->manager->requestInterruption();

52

this->manager->requestInterruption();

53

while(this->manager->isRunning());

53

while(this->manager->isRunning());

54

}

54

}

55

56

void stardundeeSPW_USB::toggleBridgeConnection()

56

void stardundeeSPW_USB::toggleBridgeConnection()

57

{

57

{

58

if(this->plugin->isConnected())

58

if(this->plugin->isConnected())

59

{

59

{

60

this->disconnectBridge();

60

this->disconnectBridge();

61

}

61

}

62

else

62

else

63

{

63

{

64

this->connectBridge();

64

this->connectBridge();

65

}

65

}

66

}

66

}

67

68

bool stardundeeSPW_USB::connectBridge()

68

bool stardundeeSPW_USB::connectBridge()

69

{

69

{

70

if(this->manager->connectBridge())

70

if(this->manager->connectBridge())

71

{

71

{

72

this->timecodeFrequencyChanged( ((StarDundeeGUI*)this->p_GUI)->getTimecodeFrequency());

72

this->timecodeFrequencyChanged( ((StarDundeeGUI*)this->p_GUI)->getTimecodeFrequency());

73

this->startSendingTimecodes( ((StarDundeeGUI*)this->p_GUI)->getStartSendingTimecodes());

73

this->startSendingTimecodes( ((StarDundeeGUI*)this->p_GUI)->getStartSendingTimecodes());

74

((StarDundeeGUI*)this->p_GUI)->lock(true);

74

((StarDundeeGUI*)this->p_GUI)->lock(true);

75

emit setConnected(true);

75

emit setConnected(true);

76

return true;

76

return true;

77

}

77

}

78

return false;

78

return false;

79

}

79

}

80

81

bool stardundeeSPW_USB::disconnectBridge()

81

bool stardundeeSPW_USB::disconnectBridge()

82

{

82

{

83

if(this->manager->disconnectBridge())

83

if(this->manager->disconnectBridge())

84

{

84

{

85

((StarDundeeGUI*)this->p_GUI)->lock(false);

85

((StarDundeeGUI*)this->p_GUI)->lock(false);

86

emit setConnected(false);

86

emit setConnected(false);

87

return true;

87

return true;

88

}

88

}

89

return false;

89

return false;

90

}

90

}

91

92

int stardundeeSPW_USB::pushRMAPPacket(char *packet, int size)

92

int stardundeeSPW_USB::pushRMAPPacket(char *packet, int size)

93

{

93

{

94

return this->manager->sendPacket(packet,size);

94

return this->manager->sendPacket(packet,size);

95

}

95

}

96

97

unsigned int stardundeeSPW_USB::Write(unsigned int *Value, unsigned int count, unsigned int address)

97

unsigned int stardundeeSPW_USB::Write(unsigned int *Value, unsigned int count, unsigned int address)

98

{

98

{

99

char writeBuffer[RMAP_WRITE_PACKET_MIN_SZ((RMAP_MAX_XFER_SIZE*4))+1];

99

char writeBuffer[RMAP_WRITE_PACKET_MIN_SZ((RMAP_MAX_XFER_SIZE*4))+1];

100

char *RMAPAckBuff;

100

char *RMAPAckBuff;

101

writeBuffer[0]=this->manager->linkNumber;//Link number

101

writeBuffer[0]=this->manager->linkNumber;//Link number

102

int transactionID = 0;

102

int transactionID = 0;

103

int written=0;

103

int written=0;

104

SocExplorerEngine::message(this->plugin,"Enter Write function",2);

104

SocExplorerEngine::message(this->plugin,"Enter Write function",2);

105

QProgressBar* progress=NULL;

105

QProgressBar* progress=NULL;

106

SocExplorerAutoProgressBar autopb;

106

SocExplorerAutoProgressBar autopb;

107

if(count>RMAP_MAX_XFER_SIZE)

107

if(count>RMAP_MAX_XFER_SIZE)

108

{

108

{

109

progress= SocExplorerEngine::getProgressBar("Writing on SPW @0x"+QString::number(address,16)+" %v of "+QString::number(count)+" words ",count);

109

progress= SocExplorerEngine::getProgressBar("Writing on SPW @0x"+QString::number(address,16)+" %v of "+QString::number(count)+" words ",count);

110

autopb.setProgressBar(progress);

110

autopb.setProgressBar(progress);

111

}

111

}

112

//Quite stupide loop, I guess that I always get the number of byte I asked for!

112

//Quite stupide loop, I guess that I always get the number of byte I asked for!

113

while(count>=RMAP_MAX_XFER_SIZE)

113

while(count>=RMAP_MAX_XFER_SIZE)

114

{

114

{

115

for(int i=0;i<(RMAP_MAX_XFER_SIZE);i++)

115

for(int i=0;i<(RMAP_MAX_XFER_SIZE);i++)

116

{

116

{

117

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+1] = (char)(((unsigned int)Value[i+written]>>24)&0xFF);

117

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+1] = (char)(((unsigned int)Value[i+written]>>24)&0xFF);

118

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+2] = (char)(((unsigned int)Value[i+written]>>16)&0xFF);

118

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+2] = (char)(((unsigned int)Value[i+written]>>16)&0xFF);

119

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+3] = (char)(((unsigned int)Value[i+written]>>8)&0xFF);

119

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+3] = (char)(((unsigned int)Value[i+written]>>8)&0xFF);

120

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+4] = (char)(((unsigned int)Value[i+written])&0xFF);

120

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+4] = (char)(((unsigned int)Value[i+written])&0xFF);

121

}

121

}

122

transactionID=manager->getRMAPtransactionID();

122

transactionID=manager->getRMAPtransactionID();

123

SocExplorerEngine::message(this->plugin,QString("Sending Write request with ID=%1").arg(transactionID),2);

123

SocExplorerEngine::message(this->plugin,QString("Sending Write request with ID=%1").arg(transactionID),2);

124

RMAP_build_tx_request_header(

124

RMAP_build_tx_request_header(

125

this->manager->destinationLogicalAddress,

125

this->manager->destinationLogicalAddress,

126

this->manager->destinationKey,

126

this->manager->destinationKey,

127

this->manager->sourceLogicalAddress,

127

this->manager->sourceLogicalAddress,

128

transactionID,

128

transactionID,

129

address+(written*4),

129

address+(written*4),

130

RMAP_MAX_XFER_SIZE*4,

130

RMAP_MAX_XFER_SIZE*4,

131

writeBuffer+1);

131

writeBuffer+1);

132

manager->sendPacket(writeBuffer,RMAP_WRITE_PACKET_MIN_SZ(RMAP_MAX_XFER_SIZE*4)+1);

132

manager->sendPacket(writeBuffer,RMAP_WRITE_PACKET_MIN_SZ(RMAP_MAX_XFER_SIZE*4)+1);

133

manager->getRMAPanswer(transactionID,&RMAPAckBuff);

133

manager->getRMAPanswer(transactionID,&RMAPAckBuff);

134

free(RMAPAckBuff);

134

free(RMAPAckBuff);

135

written+=RMAP_MAX_XFER_SIZE;

135

written+=RMAP_MAX_XFER_SIZE;

136

count-=RMAP_MAX_XFER_SIZE;

136

count-=RMAP_MAX_XFER_SIZE;

137

progress->setValue(written);

137

progress->setValue(written);

138

qApp->processEvents();

138

qApp->processEvents();

139

}

139

}

140

if(count>0)

140

if(count>0)

141

{

141

{

142

for(int i=0;i<((int)count);i++)

142

for(int i=0;i<((int)count);i++)

143

{

143

{

144

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+1] = (char)(((unsigned int)Value[i+written]>>24)&0xFF);

144

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+1] = (char)(((unsigned int)Value[i+written]>>24)&0xFF);

145

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+2] = (char)(((unsigned int)Value[i+written]>>16)&0xFF);

145

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+2] = (char)(((unsigned int)Value[i+written]>>16)&0xFF);

146

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+3] = (char)(((unsigned int)Value[i+written]>>8)&0xFF);

146

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+3] = (char)(((unsigned int)Value[i+written]>>8)&0xFF);

147

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+4] = (char)(((unsigned int)Value[i+written])&0xFF);

147

writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+4] = (char)(((unsigned int)Value[i+written])&0xFF);

148

}

148

}

149

transactionID=manager->getRMAPtransactionID();

149

transactionID=manager->getRMAPtransactionID();

150

SocExplorerEngine::message(this->plugin,QString("Sending Write request with ID=%1").arg(transactionID),2);

150

SocExplorerEngine::message(this->plugin,QString("Sending Write request with ID=%1").arg(transactionID),2);

151

RMAP_build_tx_request_header(

151

RMAP_build_tx_request_header(

152

this->manager->destinationLogicalAddress,

152

this->manager->destinationLogicalAddress,

153

this->manager->destinationKey,

153

this->manager->destinationKey,

154

this->manager->sourceLogicalAddress,

154

this->manager->sourceLogicalAddress,

155

transactionID,

155

transactionID,

156

address+(written*4),

156

address+(written*4),

157

count*4,

157

count*4,

158

writeBuffer+1);

158

writeBuffer+1);

159

manager->sendPacket(writeBuffer,RMAP_WRITE_PACKET_MIN_SZ(count*4) +1);

159

manager->sendPacket(writeBuffer,RMAP_WRITE_PACKET_MIN_SZ(count*4) +1);

160

manager->getRMAPanswer(transactionID,&RMAPAckBuff);

160

manager->getRMAPanswer(transactionID,&RMAPAckBuff);

161

free(RMAPAckBuff);

161

free(RMAPAckBuff);

162

written+=count;

162

written+=count;

163

if(progress!=NULL)

163

if(progress!=NULL)

164

{

164

{

165

progress->setValue(written);

165

progress->setValue(written);

166

qApp->processEvents();

166

qApp->processEvents();

167

}

167

}

168

}

168

}

169

return written;

169

return written;

170

}

170

}

171

172

unsigned int stardundeeSPW_USB::Read(unsigned int *Value, unsigned int count, unsigned int address)

172

unsigned int stardundeeSPW_USB::Read(unsigned int *Value, unsigned int count, unsigned int address)

173

{

173

{

174

char requestBuffer[RMAP_READ_HEADER_MIN_SZ+1];

174

char requestBuffer[RMAP_READ_HEADER_MIN_SZ+1];

175

char* RMAP_AnswerBuffer;

175

char* RMAP_AnswerBuffer;

176

requestBuffer[0]=this->manager->linkNumber;//Link number

176

requestBuffer[0]=this->manager->linkNumber;//Link number

177

int transactionID = 0;

177

int transactionID = 0;

178

int read=0;

178

int read=0;

179

QProgressBar* progress=NULL;

179

QProgressBar* progress=NULL;

180

SocExplorerAutoProgressBar autopb;

180

SocExplorerAutoProgressBar autopb;

181

if(count>RMAP_MAX_XFER_SIZE)

181

if(count>RMAP_MAX_XFER_SIZE)

182

{

182

{

183

progress= SocExplorerEngine::getProgressBar("Reading on SPW @0x"+QString::number(address,16)+" %v of "+QString::number(count)+" words ",count);

183

progress= SocExplorerEngine::getProgressBar("Reading on SPW @0x"+QString::number(address,16)+" %v of "+QString::number(count)+" words ",count);

184

autopb.setProgressBar(progress);

184

autopb.setProgressBar(progress);

185

}

185

}

186

SocExplorerEngine::message(this->plugin,QString("Enter read function, count=%1, RMAP_MAX_XFER_SIZE=%2").arg(count).arg(RMAP_MAX_XFER_SIZE),2);

186

SocExplorerEngine::message(this->plugin,QString("Enter read function, count=%1, RMAP_MAX_XFER_SIZE=%2").arg(count).arg(RMAP_MAX_XFER_SIZE),2);

187

188

//Quite stupide loop, I guess that I always get the number of byte I asked for!

188

//Quite stupide loop, I guess that I always get the number of byte I asked for!

189

while((int)count>=(int)RMAP_MAX_XFER_SIZE)

189

while((int)count>=(int)RMAP_MAX_XFER_SIZE)

190

{

190

{

191

transactionID = manager->getRMAPtransactionID();

191

transactionID = manager->getRMAPtransactionID();

192

SocExplorerEngine::message(this->plugin,QString("New transactionID:%1").arg(transactionID),2);

192

SocExplorerEngine::message(this->plugin,QString("New transactionID:%1").arg(transactionID),2);

193

RMAP_build_rx_request_header(

193

RMAP_build_rx_request_header(

194

this->manager->destinationLogicalAddress,

194

this->manager->destinationLogicalAddress,

195

this->manager->destinationKey,

195

this->manager->destinationKey,

196

this->manager->sourceLogicalAddress,

196

this->manager->sourceLogicalAddress,

197

transactionID,

197

transactionID,

198

address+(read*4),

198

address+(read*4),

199

RMAP_MAX_XFER_SIZE*4,

199

RMAP_MAX_XFER_SIZE*4,

200

requestBuffer+1);

200

requestBuffer+1);

201

manager->sendPacket(requestBuffer,RMAP_READ_HEADER_MIN_SZ+1);

201

manager->sendPacket(requestBuffer,RMAP_READ_HEADER_MIN_SZ+1);

202

int len=manager->getRMAPanswer(transactionID,&RMAP_AnswerBuffer);

202

int len=manager->getRMAPanswer(transactionID,&RMAP_AnswerBuffer);

203

if(len==-1)

203

if(len==-1)

204

{

204

{

205

this->toggleBridgeConnection();

205

this->toggleBridgeConnection();

206

return 0;

206

return 0;

207

}

207

}

208

for(int i=0;i<((len-13)/4);i++)

208

for(int i=0;i<((len-13)/4);i++)

209

{

209

{

210

Value[read+i] = 0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+12]);

210

Value[read+i] = 0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+12]);

211

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+13]));

211

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+13]));

212

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+14]));

212

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+14]));

213

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+15]));

213

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+15]));

214

}

214

}

215

free(RMAP_AnswerBuffer);

215

free(RMAP_AnswerBuffer);

216

read+=RMAP_MAX_XFER_SIZE;

216

read+=RMAP_MAX_XFER_SIZE;

217

count-=RMAP_MAX_XFER_SIZE;

217

count-=RMAP_MAX_XFER_SIZE;

218

progress->setValue(read);

218

progress->setValue(read);

219

qApp->processEvents();

219

qApp->processEvents();

220

}

220

}

221

if((int)count>0)

221

if((int)count>0)

222

{

222

{

223

transactionID = manager->getRMAPtransactionID();

223

transactionID = manager->getRMAPtransactionID();

224

SocExplorerEngine::message(this->plugin,QString("New transactionID: %1").arg(transactionID),2);

224

SocExplorerEngine::message(this->plugin,QString("New transactionID: %1").arg(transactionID),2);

225

SocExplorerEngine::message(this->plugin,QString("Building request with:"),2);

225

SocExplorerEngine::message(this->plugin,QString("Building request with:"),2);

226

SocExplorerEngine::message(this->plugin,QString("Address = %1").arg(address+(read*4),8,16),2);

226

SocExplorerEngine::message(this->plugin,QString("Address = %1").arg(address+(read*4),8,16),2);

227

SocExplorerEngine::message(this->plugin,QString("Size = %1").arg(count*4),2);

227

SocExplorerEngine::message(this->plugin,QString("Size = %1").arg(count*4),2);

228

SocExplorerEngine::message(this->plugin,QString("Size + 13 = %1").arg((count*4)+13),2);

228

SocExplorerEngine::message(this->plugin,QString("Size + 13 = %1").arg((count*4)+13),2);

229

RMAP_build_rx_request_header(

229

RMAP_build_rx_request_header(

230

this->manager->destinationLogicalAddress,

230

this->manager->destinationLogicalAddress,

231

this->manager->destinationKey,

231

this->manager->destinationKey,

232

this->manager->sourceLogicalAddress,

232

this->manager->sourceLogicalAddress,

233

transactionID,

233

transactionID,

234

address+(read*4),

234

address+(read*4),

235

count*4,

235

count*4,

236

requestBuffer+1);

236

requestBuffer+1);

237

manager->sendPacket(requestBuffer,RMAP_READ_HEADER_MIN_SZ+1);

237

manager->sendPacket(requestBuffer,RMAP_READ_HEADER_MIN_SZ+1);

238

int len=manager->getRMAPanswer(transactionID,&RMAP_AnswerBuffer);

238

int len=manager->getRMAPanswer(transactionID,&RMAP_AnswerBuffer);

239

if(len==-1)

239

if(len==-1)

240

{

240

{

241

this->toggleBridgeConnection();

241

this->toggleBridgeConnection();

242

return 0;

242

return 0;

243

}

243

}

244

for(int i=0;i<((len-13)/4);i++)

244

for(int i=0;i<((len-13)/4);i++)

245

{

245

{

246

Value[read+i] = 0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+12]);

246

Value[read+i] = 0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+12]);

247

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+13]));

247

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+13]));

248

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+14]));

248

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+14]));

249

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+15]));

249

Value[read+i] = (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+15]));

250

}

250

}

251

free(RMAP_AnswerBuffer);

251

free(RMAP_AnswerBuffer);

252

read+=count;

252

read+=count;

253

if(progress!=NULL)

253

if(progress!=NULL)

254

{

254

{

255

progress->setValue(read);

255

progress->setValue(read);

256

qApp->processEvents();

256

qApp->processEvents();

257

}

257

}

258

}

258

}

259

return read;

259

return read;

260

}

260

}

261

262

void stardundeeSPW_USB::brickSelectionChanged(int brickIndex)

262

void stardundeeSPW_USB::brickSelectionChanged(int brickIndex)

263

{

263

{

264

this->manager->selectedBrick = brickIndex-1;

264

this->manager->selectedBrick = brickIndex-1;

265

SocExplorerEngine::message(plugin,QString("Changing brick index: %1").arg(manager->selectedBrick),1);

265

SocExplorerEngine::message(plugin,QString("Changing brick index: %1").arg(manager->selectedBrick),1);

266

}

266

}

267

268

void stardundeeSPW_USB::linkNumberSelectionChanged(int linkIndex)

268

void stardundeeSPW_USB::linkNumberSelectionChanged(int linkIndex)

269

{

269

{

270

this->manager->linkNumber = linkIndex + 1;

270

this->manager->linkNumber = linkIndex + 1;

271

SocExplorerEngine::message(plugin,QString("Changing Link Number: %1").arg(manager->linkNumber),1);

271

SocExplorerEngine::message(plugin,QString("Changing Link Number: %1").arg(manager->linkNumber),1);

272

}

272

}

273

274

void stardundeeSPW_USB::linkSpeedSelectionChanged(const QString &linkSpeed)

274

void stardundeeSPW_USB::linkSpeedSelectionChanged(const QString &linkSpeed)

275

{

275

{

276

this->manager->linkSpeed = linkSpeed.toInt();

276

this->manager->linkSpeed = linkSpeed.toInt();

277

278

SocExplorerEngine::message(plugin,QString("Changing Link Speed: %1").arg(manager->linkSpeed),1);

278

SocExplorerEngine::message(plugin,QString("Changing Link Speed: %1").arg(manager->linkSpeed),1);

279

}

279

}

280

281

void stardundeeSPW_USB::sourceLogicalAddressChanged(const QString &sourceAddress)

281

void stardundeeSPW_USB::sourceLogicalAddressChanged(const QString &sourceAddress)

282

{

282

{

283

this->manager->sourceLogicalAddress = sourceAddress.toInt();

283

this->manager->sourceLogicalAddress = sourceAddress.toInt();

284

SocExplorerEngine::message(plugin,QString("Changing Destination Key: %1").arg(manager->sourceLogicalAddress),1);

284

SocExplorerEngine::message(plugin,QString("Changing Destination Key: %1").arg(manager->sourceLogicalAddress),1);

285

}

285

}

286

287

void stardundeeSPW_USB::destinationAddressChanged(const QString &rmapaddress)

287

void stardundeeSPW_USB::destinationAddressChanged(const QString &rmapaddress)

288

{

288

{

289

this->manager->destinationLogicalAddress = rmapaddress.toInt();

289

this->manager->destinationLogicalAddress = rmapaddress.toInt();

290

SocExplorerEngine::message(plugin,QString("Changing RMAP address: %1").arg(manager->destinationLogicalAddress),1);

290

SocExplorerEngine::message(plugin,QString("Changing RMAP address: %1").arg(manager->destinationLogicalAddress),1);

291

}

291

}

292

293

void stardundeeSPW_USB::destinationKeyChanged(const QString &key)

293

void stardundeeSPW_USB::destinationKeyChanged(const QString &key)

294

{

294

{

295

this->manager->destinationKey = key.toInt();

295

this->manager->destinationKey = key.toInt();

296

SocExplorerEngine::message(plugin,QString("Changing RMAP Key: %1").arg(manager->destinationKey),1);

296

SocExplorerEngine::message(plugin,QString("Changing RMAP Key: %1").arg(manager->destinationKey),1);

297

}

297

}

298

299

void stardundeeSPW_USB::brickModeChanged( bool interfaceMode )

299

void stardundeeSPW_USB::brickModeChanged( bool interfaceMode )

300

{

300

{

301

this->manager->interfaceMode = interfaceMode;

301

this->manager->interfaceMode = interfaceMode;

302

}

302

}

303

304

void stardundeeSPW_USB::timecodeFrequencyChanged(const QString &frequency)

304

void stardundeeSPW_USB::timecodeFrequencyChanged(const QString &frequency)

305

{

305

{

306

this->manager->timecodeFrequency = frequency.toDouble();

306

this->manager->timecodeFrequency = frequency.toDouble();

307

this->manager->setTimecodeFrequency( this->manager->timecodeFrequency);

307

this->manager->setTimecodeFrequency( this->manager->timecodeFrequency);

308

SocExplorerEngine::message(plugin,QString("Changing timecode frequency: %1").arg(manager->timecodeFrequency),1);

308

SocExplorerEngine::message(plugin,QString("Changing timecode frequency: %1").arg(manager->timecodeFrequency),1);

309

}

309

}

310

311

void stardundeeSPW_USB::startSendingTimecodes(bool onOff )

311

void stardundeeSPW_USB::startSendingTimecodes(bool onOff )

312

{

312

{

313

this->manager->sendTimecodePeriodically( onOff );

313

this->manager->sendTimecodePeriodically( onOff );

314

}

314

}

315

316

void stardundeeSPW_USB::rmapTimeoutChanged(const QString &timeout)

316

void stardundeeSPW_USB::rmapTimeoutChanged(const QString &timeout)

317

{

317

{

318

int tim=timeout.toInt();

318

int tim=timeout.toInt();

319

if(tim<50)

319

if(tim<50)

320

{

320

{

321

tim = 50;

321

tim = 50;

322

((StarDundeeGUI*)this->p_GUI)->setRmapTimeout(QString("%1").arg(tim));

322

((StarDundeeGUI*)this->p_GUI)->setRmapTimeout(QString("%1").arg(tim));

323

}

323

}

324

this->manager->RMAPtimeout = tim;

324

this->manager->RMAPtimeout = tim;

325

SocExplorerEngine::message(plugin,QString("Changing RMAP Timeout: %1").arg(manager->RMAPtimeout),1);

325

SocExplorerEngine::message(plugin,QString("Changing RMAP Timeout: %1").arg(manager->RMAPtimeout),1);

326

}

326

}

327

328

void stardundeeSPW_USB::makeGUI(socexplorerplugin *parent)

328

void stardundeeSPW_USB::makeGUI(socexplorerplugin *parent)

329

{

329

{

330

Q_UNUSED(parent)

330

Q_UNUSED(parent)

331

this->p_GUI = new StarDundeeGUI();

331

this->p_GUI = new StarDundeeGUI();

332

// this->mainLayout = new QGridLayout(this->p_GUI);

332

// this->mainLayout = new QGridLayout(this->p_GUI);

333

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(connectClicked()),this,SLOT(toggleBridgeConnection()));

333

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(connectClicked()),this,SLOT(toggleBridgeConnection()));

334

connect(this->manager,SIGNAL(updateAvailableBrickCount(int)),((StarDundeeGUI*)this->p_GUI),SLOT(updateAvailableBrickCount(int)));

334

connect(this->manager,SIGNAL(updateAvailableBrickCount(int)),((StarDundeeGUI*)this->p_GUI),SLOT(updateAvailableBrickCount(int)));

335

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(brickSelectionChanged(int)),this,SLOT(brickSelectionChanged(int)));

335

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(brickSelectionChanged(int)),this,SLOT(brickSelectionChanged(int)));

336

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(linkNumberSelectionChanged(int)),this,SLOT(linkNumberSelectionChanged(int)));

336

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(linkNumberSelectionChanged(int)),this,SLOT(linkNumberSelectionChanged(int)));

337

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(linkSpeedSelectionChanged(QString)),this,SLOT(linkSpeedSelectionChanged(QString)));

337

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(linkSpeedSelectionChanged(QString)),this,SLOT(linkSpeedSelectionChanged(QString)));

338

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(sourceLogicalAddressChanged(QString)),this,SLOT(sourceLogicalAddressChanged(QString)));

338

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(sourceLogicalAddressChanged(QString)),this,SLOT(sourceLogicalAddressChanged(QString)));

339

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(rmapAddressChanged(QString)),this,SLOT(destinationAddressChanged(QString)));

339

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(rmapAddressChanged(QString)),this,SLOT(destinationAddressChanged(QString)));

340

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(destinationKeyChanged(QString)),this,SLOT(destinationKeyChanged(QString)));

340

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(destinationKeyChanged(QString)),this,SLOT(destinationKeyChanged(QString)));

341

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(rmapTimeoutChanged(QString)),this,SLOT(rmapTimeoutChanged(QString)));

341

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(rmapTimeoutChanged(QString)),this,SLOT(rmapTimeoutChanged(QString)));

342

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(brickModeChanged(bool)), this, SLOT(brickModeChanged(bool)));

342

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(brickModeChanged(bool)), this, SLOT(brickModeChanged(bool)));

343

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(timecodeFrequencyChange(QString)), this, SLOT(timecodeFrequencyChanged(QString)));

343

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(timecodeFrequencyChange(QString)), this, SLOT(timecodeFrequencyChanged(QString)));

344

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(startSendingTimecode(bool)), this, SLOT(startSendingTimecodes(bool)));

344

connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(startSendingTimecode(bool)), this, SLOT(startSendingTimecodes(bool)));

345

346

this->brickSelectionChanged( ((StarDundeeGUI*)this->p_GUI)->getBrickSelection());

346

this->brickSelectionChanged( ((StarDundeeGUI*)this->p_GUI)->getBrickSelection());

347

this->linkNumberSelectionChanged( ((StarDundeeGUI*)this->p_GUI)->getLinkNumberSelection());

347

this->linkNumberSelectionChanged( ((StarDundeeGUI*)this->p_GUI)->getLinkNumberSelection());

348

this->linkSpeedSelectionChanged( ((StarDundeeGUI*)this->p_GUI)->getLinkSpeedSelection());

348

this->linkSpeedSelectionChanged( ((StarDundeeGUI*)this->p_GUI)->getLinkSpeedSelection());

349

this->sourceLogicalAddressChanged(((StarDundeeGUI*)this->p_GUI)->getSourceAddress());

349

this->sourceLogicalAddressChanged(((StarDundeeGUI*)this->p_GUI)->getSourceAddress());

350

this->destinationAddressChanged( ((StarDundeeGUI*)this->p_GUI)->getDestinationAddress());

350

this->destinationAddressChanged( ((StarDundeeGUI*)this->p_GUI)->getDestinationAddress());

351

this->destinationKeyChanged( ((StarDundeeGUI*)this->p_GUI)->getDestinationKey());

351

this->destinationKeyChanged( ((StarDundeeGUI*)this->p_GUI)->getDestinationKey());

352

this->rmapTimeoutChanged( ((StarDundeeGUI*)this->p_GUI)->getRmapTimeout());

352

this->rmapTimeoutChanged( ((StarDundeeGUI*)this->p_GUI)->getRmapTimeout());

353

this->brickModeChanged( ((StarDundeeGUI*)this->p_GUI)->isBrickSetAsAnInterface());

353

this->brickModeChanged( ((StarDundeeGUI*)this->p_GUI)->isBrickSetAsAnInterface());

354

355

connect(this,SIGNAL(SelectBrick(int)), ((StarDundeeGUI*)this->p_GUI),SLOT(selectBrick(int)));

355

connect(this,SIGNAL(SelectBrick(int)), ((StarDundeeGUI*)this->p_GUI),SLOT(selectBrick(int)));

356

connect(this,SIGNAL(SelectLinkNumber(int)), ((StarDundeeGUI*)this->p_GUI),SLOT(selectLinkNumber(int)));

356

connect(this,SIGNAL(SelectLinkNumber(int)), ((StarDundeeGUI*)this->p_GUI),SLOT(selectLinkNumber(int)));

357

connect(this,SIGNAL(SelectLinkSpeed(int)), ((StarDundeeGUI*)this->p_GUI),SLOT(selectLinkSpeed(int)));

357

connect(this,SIGNAL(SelectLinkSpeed(int)), ((StarDundeeGUI*)this->p_GUI),SLOT(selectLinkSpeed(int)));

358

connect(this,SIGNAL(SetDestinationKey(QString)), ((StarDundeeGUI*)this->p_GUI),SLOT(setDestinationKey(QString)));

358

connect(this,SIGNAL(SetDestinationKey(QString)), ((StarDundeeGUI*)this->p_GUI),SLOT(setDestinationKey(QString)));

359

connect(this,SIGNAL(SetDestinationAddress(QString)),((StarDundeeGUI*)this->p_GUI),SLOT(setDestinationAddress(QString)));

359

connect(this,SIGNAL(SetDestinationAddress(QString)),((StarDundeeGUI*)this->p_GUI),SLOT(setDestinationAddress(QString)));

360

connect(this,SIGNAL(SetSourceAddress(QString)), ((StarDundeeGUI*)this->p_GUI),SLOT(setSourceAddress(QString)));

360

connect(this,SIGNAL(SetSourceAddress(QString)), ((StarDundeeGUI*)this->p_GUI),SLOT(setSourceAddress(QString)));

361

connect(this,SIGNAL(SetRmapTimeout(QString)), ((StarDundeeGUI*)this->p_GUI),SLOT(setRmapTimeout(QString)));

361

connect(this,SIGNAL(SetRmapTimeout(QString)), ((StarDundeeGUI*)this->p_GUI),SLOT(setRmapTimeout(QString)));

362

connect(this,SIGNAL(GetAvailableBrickCount()), ((StarDundeeGUI*)this->p_GUI),SLOT(getAvailableBrickCount()));

362

connect(this,SIGNAL(GetAvailableBrickCount()), ((StarDundeeGUI*)this->p_GUI),SLOT(getAvailableBrickCount()));

363

connect(this,SIGNAL(GetNbPacketsTransmittedToSpw()),((StarDundeeGUI*)this->p_GUI),SLOT(getNbPacketsTransmittedToSpw()));

363

connect(this,SIGNAL(GetNbPacketsTransmittedToSpw()),((StarDundeeGUI*)this->p_GUI),SLOT(getNbPacketsTransmittedToSpw()));

364

connect(this,SIGNAL(GetNbCCSDSPacketsTransmittedToSpw()),

364

connect(this,SIGNAL(GetNbCCSDSPacketsTransmittedToSpw()),

365

((StarDundeeGUI*)this->p_GUI),SLOT(getNbCCSDSPacketsTransmittedToSpw()));

365

((StarDundeeGUI*)this->p_GUI),SLOT(getNbCCSDSPacketsTransmittedToSpw()));

366

connect(this,SIGNAL(SetBrickAsAnInterface(bool)), ((StarDundeeGUI*)this->p_GUI),SLOT(setBrickAsAnInterface(bool)));

366

connect(this,SIGNAL(SetBrickAsAnInterface(bool)), ((StarDundeeGUI*)this->p_GUI),SLOT(setBrickAsAnInterface(bool)));

367

connect(this,SIGNAL(SetBrickAsARouter(bool)), ((StarDundeeGUI*)this->p_GUI),SLOT(setBrickAsARouter(bool)));

367

connect(this,SIGNAL(SetBrickAsARouter(bool)), ((StarDundeeGUI*)this->p_GUI),SLOT(setBrickAsARouter(bool)));

368

connect(this,SIGNAL(BytesReceivedFromSpw(uint)), ((StarDundeeGUI*)this->p_GUI),SLOT(updateNbReceivedBytesFromSpw(uint)));

368

connect(this,SIGNAL(BytesReceivedFromSpw(uint)), ((StarDundeeGUI*)this->p_GUI),SLOT(updateNbReceivedBytesFromSpw(uint)));

369

connect(this,SIGNAL(BytesTransmittedToSpw(uint)), ((StarDundeeGUI*)this->p_GUI),SLOT(updateNbTransmittedBytesToSpw(uint)));

369

connect(this,SIGNAL(BytesTransmittedToSpw(uint)), ((StarDundeeGUI*)this->p_GUI),SLOT(updateNbTransmittedBytesToSpw(uint)));

370

connect(this,SIGNAL(CCSDSPacketTransmittedToSpw()), ((StarDundeeGUI*)this->p_GUI),SLOT(updateCCSDSPacketTransmittedToSpw()));

370

connect(this,SIGNAL(CCSDSPacketTransmittedToSpw()), ((StarDundeeGUI*)this->p_GUI),SLOT(updateCCSDSPacketTransmittedToSpw()));

371

connect(this,SIGNAL(SetTimecodeFrequency(double)), ((StarDundeeGUI*)this->p_GUI),SLOT(setTimecodeFrequency(double)));

371

connect(this,SIGNAL(SetTimecodeFrequency(double)), ((StarDundeeGUI*)this->p_GUI),SLOT(setTimecodeFrequency(double)));

372

connect(this,SIGNAL(StartSendingTimecodes(bool)), ((StarDundeeGUI*)this->p_GUI),SLOT(setStartSendingTimecodes(bool)));

372

connect(this,SIGNAL(StartSendingTimecodes(bool)), ((StarDundeeGUI*)this->p_GUI),SLOT(setStartSendingTimecodes(bool)));

373

374

connect(this,SIGNAL(SendOneTimecode(unsigned char)),this->manager, SLOT(sendOneTimecode(unsigned char)));

374

connect(this,SIGNAL(SendOneTimecode(unsigned char)),this->manager, SLOT(sendOneTimecode(unsigned char)));

375

connect(this,SIGNAL(GetLinkNumber()), this->manager, SLOT(getLinkNumber()));

375

connect(this,SIGNAL(GetLinkNumber()), this->manager, SLOT(getLinkNumber()));

376

}

376

}

377

378

void stardundeeSPW_USB::sendPacketComingFromTCPServer(char *packet, int size)

378

void stardundeeSPW_USB::sendPacketComingFromTCPServer(char *packet, int size)

379

{

379

{

380

char* data;

380

char* data;

381

int i;

381

int i;

382

383

data = (char *) malloc( size + 5 );

383

data = (char *) malloc( size + 5 );

384

385

data[0] = this->manager->linkNumber;

385

data[0] = this->manager->linkNumber;

386

data[1] = this->manager->destinationLogicalAddress; // target logical address

386

data[1] = this->manager->destinationLogicalAddress; // target logical address

387

data[2] = SPW_PROTO_ID_CCSDS; // protocol identifier

387

data[2] = SPW_PROTO_ID_CCSDS; // protocol identifier

388

data[3] = 0x00; // reserved

388

data[3] = 0x00; // reserved

389

data[4] = 0x00; // user application

389

data[4] = 0x00; // user application

390

391

for ( i=0; i<size; i++ )

391

for ( i=0; i<size; i++ )

392

{

392

{

393

data[i+5] = packet[i];

393

data[i+5] = packet[i];

394

}

394

}

395

396

this->manager->sendPacket( data, size + 5);

396

this->manager->sendPacket( data, size + 5);

397

398

free(data);

398

free(data);

399

free(packet);

399

free(packet);

400

}

400

}

401

402

stardundeeSPW_USB_Manager::stardundeeSPW_USB_Manager(socexplorerplugin *plugin, QObject *parent)

402

stardundeeSPW_USB_Manager::stardundeeSPW_USB_Manager(socexplorerplugin *plugin, QObject *parent)

403

:QThread((QObject*)parent)

403

:QThread((QObject*)parent)

404

{

404

{

405

this->RMAPtimeout = 2000;

405

this->RMAPtimeout = 2000;

406

this->handleMutex = new QMutex(QMutex::NonRecursive);

406

this->handleMutex = new QMutex(QMutex::NonRecursive);

407

// this->handleMutex = new QMutex(QMutex::Recursive);

407

// this->handleMutex = new QMutex(QMutex::Recursive);

408

this->RMAP_AnswersSem = new QSemaphore(0);

408

this->RMAP_AnswersSem = new QSemaphore(0);

409

this->RMAP_AnswersMtx=new QMutex(QMutex::Recursive);

409

this->RMAP_AnswersMtx=new QMutex(QMutex::Recursive);

410

this->RMAP_pending_transaction_IDsMtx=new QMutex(QMutex::Recursive);

410

this->RMAP_pending_transaction_IDsMtx=new QMutex(QMutex::Recursive);

411

this->plugin = plugin;

411

this->plugin = plugin;

412

connected = false;

412

connected = false;

413

// TODO remove this crap!

413

// TODO remove this crap!

414

this->initDialog();

414

this->initDialog();

415

// this->moveToThread(this);

415

// this->moveToThread(this);

416

}

416

}

417

418

stardundeeSPW_USB_Manager::~stardundeeSPW_USB_Manager()

418

stardundeeSPW_USB_Manager::~stardundeeSPW_USB_Manager()

419

{

419

{

420

this->terminate();

420

this->terminate();

421

while (!this->isFinished()) {

421

while (!this->isFinished()) {

422

this->usleep(1000);

422

this->usleep(1000);

423

}

423

}

424

}

424

}

425

426

void stardundeeSPW_USB_Manager::run()

426

void stardundeeSPW_USB_Manager::run()

427

{

427

{

428

USB_SPACEWIRE_PACKET_PROPERTIES properties;

428

USB_SPACEWIRE_PACKET_PROPERTIES properties;

429

USB_SPACEWIRE_ID pIdentifier=NULL;

429

USB_SPACEWIRE_ID pIdentifier=NULL;

430

USB_SPACEWIRE_STATUS stat;

430

USB_SPACEWIRE_STATUS stat;

431

SocExplorerEngine::message(this->plugin,"Starting Startdundee USB pooling thread",1);

431

SocExplorerEngine::message(this->plugin,"Starting Startdundee USB pooling thread",1);

432

char buffer[(RMAP_MAX_XFER_SIZE*4)+50];

432

char buffer[(RMAP_MAX_XFER_SIZE*4)+50];

433

while (!this->isInterruptionRequested())

433

while (!this->isInterruptionRequested())

434

{

434

{

435

if(this->connected)

435

if(this->connected)

436

{

436

{

437

this->handleMutex->lock();

437

this->handleMutex->lock();

438

SocExplorerEngine::message(this->plugin,"Looking for new RMAP packets",4);

438

SocExplorerEngine::message(this->plugin,"Looking for new RMAP packets",4);

439

if(USBSpaceWire_WaitOnReadPacketAvailable(hDevice,0.01))

439

if(USBSpaceWire_WaitOnReadPacketAvailable(hDevice,0.01))

440

{

440

{

441

SocExplorerEngine::message(this->plugin,"Got packet",2);

441

SocExplorerEngine::message(this->plugin,"Got packet",2);

442

stat = USBSpaceWire_ReadPackets(hDevice, buffer, (RMAP_MAX_XFER_SIZE*4)+50,1, 1, &properties, &pIdentifier);

442

stat = USBSpaceWire_ReadPackets(hDevice, buffer, (RMAP_MAX_XFER_SIZE*4)+50,1, 1, &properties, &pIdentifier);

443

if (stat == TRANSFER_SUCCESS)

443

if (stat == TRANSFER_SUCCESS)

444

{

444

{

445

if(USBSpaceWire_GetReadTrafficType(&properties, 0) ==SPACEWIRE_TRAFFIC_PACKET)

445

if(USBSpaceWire_GetReadTrafficType(&properties, 0) ==SPACEWIRE_TRAFFIC_PACKET)

446

{

446

{

447

SocExplorerEngine::message(this->plugin,"It's a SPW packet",2);

447

SocExplorerEngine::message(this->plugin,"It's a SPW packet",2);

448

if(USBSpaceWire_GetReadEOPStatus(&properties, 0)== SPACEWIRE_USB_EOP)

448

if(USBSpaceWire_GetReadEOPStatus(&properties, 0)== SPACEWIRE_USB_EOP)

449

{

449

{

450

SocExplorerEngine::message(this->plugin,"Got end of packet",2);

450

SocExplorerEngine::message(this->plugin,"Got end of packet",2);

451

emit bytesReceivedFromSpw( properties.len );

451

emit bytesReceivedFromSpw( properties.len );

452

if(buffer[1]==(char)SPW_PROTO_ID_RMAP) //RMAP packet

452

if(buffer[1]==(char)SPW_PROTO_ID_RMAP) //RMAP packet

453

{

453

{

454

RMAP_Answer* packet;

454

RMAP_Answer* packet;

455

SocExplorerEngine::message(this->plugin,"Got RMAP packet",2);

455

SocExplorerEngine::message(this->plugin,"Got RMAP packet",2);

456

SocExplorerEngine::message(this->plugin,QString("Rmap packet size %1").arg(properties.len),2);

456

SocExplorerEngine::message(this->plugin,QString("Rmap packet size %1").arg(properties.len),2);

457

char* packetbuffer = (char*)malloc(properties.len);

457

char* packetbuffer = (char*)malloc(properties.len);

458

memcpy(packetbuffer,buffer,properties.len);

458

memcpy(packetbuffer,buffer,properties.len);

459

USBSpaceWire_FreeRead(hDevice, pIdentifier);

459

USBSpaceWire_FreeRead(hDevice, pIdentifier);

460

pIdentifier = NULL;

460

pIdentifier = NULL;

461

this->handleMutex->unlock();

461

this->handleMutex->unlock();

462

if(properties.len==8)

462

if(properties.len==8)

463

{

463

{

464

packet=new RMAP_Answer(RMAP_get_transactionID(buffer),packetbuffer,properties.len);

464

packet=new RMAP_Answer(RMAP_get_transactionID(buffer),packetbuffer,properties.len);

465

}

465

}

466

else

466

else

467

{

467

{

468

packet=new RMAP_Answer(RMAP_get_transactionID(buffer+1),packetbuffer,properties.len);

468

packet=new RMAP_Answer(RMAP_get_transactionID(buffer+1),packetbuffer,properties.len);

469

}

469

}

470

RMAP_AnswersMtx->lock();

470

RMAP_AnswersMtx->lock();

471

RMAP_Answers.append(packet);

471

RMAP_Answers.append(packet);

472

RMAP_AnswersMtx->unlock();

472

RMAP_AnswersMtx->unlock();

473

RMAP_AnswersSem->release();

473

RMAP_AnswersSem->release();

474

}

474

}

475

else //any non-rmap packet will be pushed to the network

475

else //any non-rmap packet will be pushed to the network

476

{

476

{

477

char* packetbuffer = (char*)malloc(properties.len);

477

char* packetbuffer = (char*)malloc(properties.len);

478

memcpy(packetbuffer,buffer,properties.len);

478

memcpy(packetbuffer,buffer,properties.len);

479

emit emitPacket(packetbuffer,properties.len);

479

emit emitPacket(packetbuffer,properties.len);

480

USBSpaceWire_FreeRead(hDevice, pIdentifier);

480

USBSpaceWire_FreeRead(hDevice, pIdentifier);

481

this->handleMutex->unlock();

481

this->handleMutex->unlock();

482

SocExplorerEngine::message(this->plugin,"Got SPW packet",2);

482

SocExplorerEngine::message(this->plugin,"Got SPW packet",2);

483

}

483

}

484

}

484

}

485

else

485

else

486

{

486

{

487

SocExplorerEngine::message(this->plugin,"No EOP received",2);

487

SocExplorerEngine::message(this->plugin,"No EOP received",2);

488

this->handleMutex->unlock();

488

this->handleMutex->unlock();

489

}

489

}

490

}

490

}

491

492

}

492

}

493

else

493

else

494

{

494

{

495

USBSpaceWire_FreeRead(hDevice, pIdentifier);

495

USBSpaceWire_FreeRead(hDevice, pIdentifier);

496

this->handleMutex->unlock();

496

this->handleMutex->unlock();

497

}

497

}

498

}

498

}

499

else

499

else

500

{

500

{

501

USBSpaceWire_FreeRead(hDevice, pIdentifier);

501

USBSpaceWire_FreeRead(hDevice, pIdentifier);

502

this->handleMutex->unlock();

502

this->handleMutex->unlock();

503

}

503

}

504

}

504

}

505

else

505

else

506

{

506

{

507

//do some sanity checks!

507

//do some sanity checks!

508

int list = USBSpaceWire_ListDevices();

508

int list = USBSpaceWire_ListDevices();

509

if(this->brickList!=list)

509

if(this->brickList!=list)

510

{

510

{

511

this->brickList = list;

511

this->brickList = list;

512

emit updateAvailableBrickCount(this->brickList);

512

emit updateAvailableBrickCount(this->brickList);

513

}

513

}

514

usleep(RMAPtimeout/2);

514

usleep(RMAPtimeout/2);

515

}

515

}

516

usleep(1000);

516

usleep(1000);

517

}

517

}

518

SocExplorerEngine::message(this->plugin,"Exiting Startdundee USB pooling thread",1);

518

SocExplorerEngine::message(this->plugin,"Exiting Startdundee USB pooling thread",1);

519

}

519

}

520

521

bool stardundeeSPW_USB_Manager::connectBridge()

521

bool stardundeeSPW_USB_Manager::connectBridge()

522

{

522

{

523

bool ret;

523

bool ret;

524

525

if (this->interfaceMode == BRICK_IS_SET_AS_AN_INTERFACE)

525

if (this->interfaceMode == BRICK_IS_SET_AS_AN_INTERFACE)

526

{

526

{

527

ret = connectBridgeAsInterface();

527

ret = connectBridgeAsInterface();

528

}

528

}

529

else if (this->interfaceMode == BRICK_IS_SET_AS_A_ROUTER)

529

else if (this->interfaceMode == BRICK_IS_SET_AS_A_ROUTER)

530

{

530

{

531

ret = connectBridgeAsRouter();

531

ret = connectBridgeAsRouter();

532

}

532

}

533

else

533

else

534

{

534

{

535

ret = false;

535

ret = false;

536

}

536

}

537

538

return ret;

538

return ret;

539

}

539

}

540

541

bool stardundeeSPW_USB_Manager::connectBridgeAsInterface()

541

bool stardundeeSPW_USB_Manager::connectBridgeAsInterface()

542

{

542

{

543

this->handleMutex->lock();

543

this->handleMutex->lock();

544

int status;

544

int status;

545

U32 statusControl;

545

U32 statusControl;

546

this->connected = false;

546

this->connected = false;

547

if (!USBSpaceWire_Open(&hDevice, this->selectedBrick)) // Open the USB device

547

if (!USBSpaceWire_Open(&hDevice, this->selectedBrick)) // Open the USB device

548

{

548

{

549

SocExplorerEngine::message(this->plugin,"stardundee *** Open *** ERROR: USBSpaceWire_Open(&hDevice, 0))",0);

549

SocExplorerEngine::message(this->plugin,"stardundee *** Open *** ERROR: USBSpaceWire_Open(&hDevice, 0))",0);

550

this->handleMutex->unlock();

550

this->handleMutex->unlock();

551

return false;

551

return false;

552

}

552

}

553

SocExplorerEngine::message(this->plugin,"stardundee *** Open *** USBSpaceWire_Open successful",0);

553

SocExplorerEngine::message(this->plugin,"stardundee *** Open *** USBSpaceWire_Open successful",0);

554

555

USBSpaceWire_EnableNetworkMode(hDevice, 0); // deactivate the network mode

555

USBSpaceWire_EnableNetworkMode(hDevice, 0); // deactivate the network mode

556

CFGSpaceWire_EnableRMAP(1); // Enable the use of RMAP for the StarDundee brick configuration

556

CFGSpaceWire_EnableRMAP(1); // Enable the use of RMAP for the StarDundee brick configuration

557

CFGSpaceWire_SetRMAPDestinationKey(0x20); // Set the destination key expected by STAR-Dundee devices

557

CFGSpaceWire_SetRMAPDestinationKey(0x20); // Set the destination key expected by STAR-Dundee devices

558

559

// Set the path and return path to the device

559

// Set the path and return path to the device

560

CFGSpaceWire_StackClear();

560

CFGSpaceWire_StackClear();

561

CFGSpaceWire_AddrStackPush(0);

561

CFGSpaceWire_AddrStackPush(0);

562

CFGSpaceWire_AddrStackPush(254);

562

CFGSpaceWire_AddrStackPush(254);

563

CFGSpaceWire_RetAddrStackPush(254);

563

CFGSpaceWire_RetAddrStackPush(254);

564

// set the base transmit rate to 100 MHz

564

// set the base transmit rate to 100 MHz

565

status = CFGSpaceWire_SetBrickBaseTransmitRate( hDevice, CFG_BRK_CLK_100_MHZ, CFG_BRK_DVDR_1, 0xff);

565

status = CFGSpaceWire_SetBrickBaseTransmitRate( hDevice, CFG_BRK_CLK_100_MHZ, CFG_BRK_DVDR_1, 0xff);

566

if (status != CFG_TRANSFER_SUCCESS)

566

if (status != CFG_TRANSFER_SUCCESS)

567

{

567

{

568

SocExplorerEngine::message(this->plugin,"ERROR CFGSpaceWire_SetBrickBaseTransmitRate",1);

568

SocExplorerEngine::message(this->plugin,"ERROR CFGSpaceWire_SetBrickBaseTransmitRate",1);

569

this->handleMutex->unlock();

569

this->handleMutex->unlock();

570

return false;

570

return false;

571

}

571

}

572

else

572

else

573

{

573

{

574

SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_SetBrickBaseTransmitRate, base rate = 100 MHz",1);

574

SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_SetBrickBaseTransmitRate, base rate = 100 MHz",1);

575

}

575

}

576

577

// read the link status

577

// read the link status

578

if (CFGSpaceWire_GetLinkStatusControl(hDevice, this->linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)

578

if (CFGSpaceWire_GetLinkStatusControl(hDevice, this->linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)

579

{

579

{

580

SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(this->linkNumber),1);

580

SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(this->linkNumber),1);

581

this->handleMutex->unlock();

581

this->handleMutex->unlock();

582

return false;

582

return false;

583

}

583

}

584

else

584

else

585

{

585

{

586

SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(this->linkNumber),1);

586

SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(this->linkNumber),1);

587

588

// Set the link status control register properties

588

// Set the link status control register properties

589

CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);

589

CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);

590

CFGSpaceWire_LSEnableStart(&statusControl, 1);

590

CFGSpaceWire_LSEnableStart(&statusControl, 1);

591

CFGSpaceWire_LSEnableDisabled(&statusControl, 0);

591

CFGSpaceWire_LSEnableDisabled(&statusControl, 0);

592

CFGSpaceWire_LSEnableTristate(&statusControl, 0);

592

CFGSpaceWire_LSEnableTristate(&statusControl, 0);

593

CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9); // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz

593

CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9); // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz

594

595

// Set the link status control register

595

// Set the link status control register

596

if (CFGSpaceWire_SetLinkStatusControl(hDevice, this->linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)

596

if (CFGSpaceWire_SetLinkStatusControl(hDevice, this->linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)

597

{

597

{

598

SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(this->linkNumber),1);

598

SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(this->linkNumber),1);

599

this->handleMutex->unlock();

599

this->handleMutex->unlock();

600

return false;

600

return false;

601

}

601

}

602

else

602

else

603

{

603

{

604

SocExplorerEngine::message(this->plugin,"Set the link status control for link " + QString::number(this->linkNumber),1);

604

SocExplorerEngine::message(this->plugin,"Set the link status control for link " + QString::number(this->linkNumber),1);

605

}

605

}

606

}

606

}

607

608

if (CFGSpaceWire_SetAsInterface(hDevice, 1, 0) != CFG_TRANSFER_SUCCESS)

608

if (CFGSpaceWire_SetAsInterface(hDevice, 1, 0) != CFG_TRANSFER_SUCCESS)

609

{

609

{

610

SocExplorerEngine::message(this->plugin,"Could not set the device to be an interface",1);

610

SocExplorerEngine::message(this->plugin,"Could not set the device to be an interface",1);

611

this->handleMutex->unlock();

611

this->handleMutex->unlock();

612

return false;

612

return false;

613

}

613

}

614

else

614

else

615

{

615

{

616

SocExplorerEngine::message(this->plugin,"Device set to be an interface",1);

616

SocExplorerEngine::message(this->plugin,"Device set to be an interface",1);

617

}

617

}

618

619

USBSpaceWire_RegisterReceiveOnAllPorts(hDevice); // Register to receive on all ports

619

USBSpaceWire_RegisterReceiveOnAllPorts(hDevice); // Register to receive on all ports

620

USBSpaceWire_ClearEndpoints(hDevice); // clear the USB endpoints

620

USBSpaceWire_ClearEndpoints(hDevice); // clear the USB endpoints

621

USBSpaceWire_SetTimeout(hDevice,1.0);

621

USBSpaceWire_SetTimeout(hDevice,1.0);

622

this->handleMutex->unlock();

622

this->handleMutex->unlock();

623

SocExplorerEngine::message(this->plugin,"The driver's current send buffer size is " + QString::number(USBSpaceWire_GetDriverSendBufferSize(hDevice)) + " bytes",1);

623

SocExplorerEngine::message(this->plugin,"The driver's current send buffer size is " + QString::number(USBSpaceWire_GetDriverSendBufferSize(hDevice)) + " bytes",1);

624

SocExplorerEngine::message(this->plugin,"The driver's current read buffer size is " + QString::number(USBSpaceWire_GetDriverReadBufferSize(hDevice)) + " bytes",1);

624

SocExplorerEngine::message(this->plugin,"The driver's current read buffer size is " + QString::number(USBSpaceWire_GetDriverReadBufferSize(hDevice)) + " bytes",1);

625

SocExplorerEngine::message(this->plugin,"USBSpaceWire_IsReadThrottling is " + QString::number(USBSpaceWire_IsReadThrottling(hDevice)),1);

625

SocExplorerEngine::message(this->plugin,"USBSpaceWire_IsReadThrottling is " + QString::number(USBSpaceWire_IsReadThrottling(hDevice)),1);

626

this->connected = true;

626

this->connected = true;

627

return true;

627

return true;

628

}

628

}

629

630

bool stardundeeSPW_USB_Manager::connectBridgeAsRouter()

630

bool stardundeeSPW_USB_Manager::connectBridgeAsRouter()

631

{

631

{

632

// QMutexLocker mlock(&this->handleMutex);

632

// QMutexLocker mlock(&this->handleMutex);

633

this->handleMutex->lock();

633

this->handleMutex->lock();

634

int status;

634

int status;

635

U32 statusControl;

635

U32 statusControl;

636

unsigned int linkStatus1;

636

unsigned int linkStatus1;

637

unsigned int linkStatus2;

637

unsigned int linkStatus2;

638

unsigned char linkNumber;

638

unsigned char linkNumber;

639

unsigned char deviceIsAnInterface;

639

unsigned char deviceIsAnInterface;

640

641

if (!USBSpaceWire_Open(&hDevice, this->selectedBrick)) // Open the USB device

641

if (!USBSpaceWire_Open(&hDevice, this->selectedBrick)) // Open the USB device

642

{

642

{

643

SocExplorerEngine::message(this->plugin,"stardundee *** Open *** ERROR: USBSpaceWire_Open(&hDevice, 0))");

643

SocExplorerEngine::message(this->plugin,"stardundee *** Open *** ERROR: USBSpaceWire_Open(&hDevice, 0))");

644

this->handleMutex->unlock();

644

this->handleMutex->unlock();

645

return false;

645

return false;

646

}

646

}

647

SocExplorerEngine::message(this->plugin,"stardundee *** Open *** USBSpaceWire_Open successful, device number: "

647

SocExplorerEngine::message(this->plugin,"stardundee *** Open *** USBSpaceWire_Open successful, device number: "

648

+ QString::number(this->selectedBrick));

648

+ QString::number(this->selectedBrick));

649

650

USBSpaceWire_EnableNetworkMode(hDevice, 0); // deactivate the network mode

650

USBSpaceWire_EnableNetworkMode(hDevice, 0); // deactivate the network mode

651

CFGSpaceWire_EnableRMAP(1); // Enable the use of RMAP for the StarDundee brick configuration

651

CFGSpaceWire_EnableRMAP(1); // Enable the use of RMAP for the StarDundee brick configuration

652

CFGSpaceWire_SetRMAPDestinationKey(0x20); // Set the destination key expected by STAR-Dundee devices

652

CFGSpaceWire_SetRMAPDestinationKey(0x20); // Set the destination key expected by STAR-Dundee devices

653

654

// Set the path and return path to the device

654

// Set the path and return path to the device

655

// This affects just the operations performed by the Configuration Library and does not affect the packets

655

// This affects just the operations performed by the Configuration Library and does not affect the packets

656

// sent and received using the driver API.

656

// sent and received using the driver API.

657

CFGSpaceWire_StackClear();

657

CFGSpaceWire_StackClear();

658

CFGSpaceWire_AddrStackPush(0);

658

CFGSpaceWire_AddrStackPush(0);

659

CFGSpaceWire_AddrStackPush(254);

659

CFGSpaceWire_AddrStackPush(254);

660

CFGSpaceWire_RetAddrStackPush(254);

660

CFGSpaceWire_RetAddrStackPush(254);

661

662

// set the base transmit rate to 100 MHz

662

// set the base transmit rate to 100 MHz

663

status = CFGSpaceWire_SetBrickBaseTransmitRate( hDevice, CFG_BRK_CLK_100_MHZ, CFG_BRK_DVDR_1, 0xff);

663

status = CFGSpaceWire_SetBrickBaseTransmitRate( hDevice, CFG_BRK_CLK_100_MHZ, CFG_BRK_DVDR_1, 0xff);

664

if (status != CFG_TRANSFER_SUCCESS)

664

if (status != CFG_TRANSFER_SUCCESS)

665

{

665

{

666

SocExplorerEngine::message(this->plugin,"ERROR CFGSpaceWire_SetBrickBaseTransmitRate");

666

SocExplorerEngine::message(this->plugin,"ERROR CFGSpaceWire_SetBrickBaseTransmitRate");

667

}

667

}

668

else SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_SetBrickBaseTransmitRate, base rate = 100 MHz");

668

else SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_SetBrickBaseTransmitRate, base rate = 100 MHz");

669

670

//*********************

670

//*********************

671

// LINK 1 CONFIGURATION

671

// LINK 1 CONFIGURATION

672

linkNumber = 1;

672

linkNumber = 1;

673

if (CFGSpaceWire_GetLinkStatusControl(hDevice, linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)

673

if (CFGSpaceWire_GetLinkStatusControl(hDevice, linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)

674

SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(linkNumber));

674

SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(linkNumber));

675

else

675

else

676

{

676

{

677

SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(linkNumber));

677

SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(linkNumber));

678

679

// Set the link status control register properties

679

// Set the link status control register properties

680

CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);

680

CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);

681

CFGSpaceWire_LSEnableStart(&statusControl, 1);

681

CFGSpaceWire_LSEnableStart(&statusControl, 1);

682

CFGSpaceWire_LSEnableDisabled(&statusControl, 0);

682

CFGSpaceWire_LSEnableDisabled(&statusControl, 0);

683

CFGSpaceWire_LSEnableTristate(&statusControl, 0);

683

CFGSpaceWire_LSEnableTristate(&statusControl, 0);

684

CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9); // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz

684

CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9); // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz

685

686

// Set the link status control register

686

// Set the link status control register

687

if (CFGSpaceWire_SetLinkStatusControl(hDevice, linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)

687

if (CFGSpaceWire_SetLinkStatusControl(hDevice, linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)

688

SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(linkNumber));

688

SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(linkNumber));

689

else

689

else

690

SocExplorerEngine::message(this->plugin,"link status control for link " + QString::number(0x01) + " is set");

690

SocExplorerEngine::message(this->plugin,"link status control for link " + QString::number(0x01) + " is set");

691

}

691

}

692

693

//*********************

693

//*********************

694

// LINK 2 CONFIGURATION

694

// LINK 2 CONFIGURATION

695

linkNumber = 2;

695

linkNumber = 2;

696

if (CFGSpaceWire_GetLinkStatusControl(hDevice, linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)

696

if (CFGSpaceWire_GetLinkStatusControl(hDevice, linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)

697

SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(linkNumber));

697

SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(linkNumber));

698

else

698

else

699

{

699

{

700

SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(linkNumber));

700

SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(linkNumber));

701

702

// Set the link status control register properties

702

// Set the link status control register properties

703

CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);

703

CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);

704

CFGSpaceWire_LSEnableStart(&statusControl, 1);

704

CFGSpaceWire_LSEnableStart(&statusControl, 1);

705

CFGSpaceWire_LSEnableDisabled(&statusControl, 0);

705

CFGSpaceWire_LSEnableDisabled(&statusControl, 0);

706

CFGSpaceWire_LSEnableTristate(&statusControl, 0);

706

CFGSpaceWire_LSEnableTristate(&statusControl, 0);

707

CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9); // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz

707

CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9); // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz

708

709

// Set the link status control register

709

// Set the link status control register

710

if (CFGSpaceWire_SetLinkStatusControl(hDevice, linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)

710

if (CFGSpaceWire_SetLinkStatusControl(hDevice, linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)

711

SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(linkNumber));

711

SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(linkNumber));

712

else

712

else

713

SocExplorerEngine::message(this->plugin,"link status control for link " + QString::number(linkNumber) + " is set");

713

SocExplorerEngine::message(this->plugin,"link status control for link " + QString::number(linkNumber) + " is set");

714

}

714

}

715

716

//***************************

716

//***************************

717

// SET THE DEVICE AS A ROUTER

717

// SET THE DEVICE AS A ROUTER

718

deviceIsAnInterface = 0; // 0 = router, 1 = interface

718

deviceIsAnInterface = 0; // 0 = router, 1 = interface

719

if (CFGSpaceWire_SetAsInterface(hDevice, deviceIsAnInterface, 0) != CFG_TRANSFER_SUCCESS)

719

if (CFGSpaceWire_SetAsInterface(hDevice, deviceIsAnInterface, 0) != CFG_TRANSFER_SUCCESS)

720

SocExplorerEngine::message(this->plugin,"Could not set the device to be an interface");

720

SocExplorerEngine::message(this->plugin,"Could not set the device to be an interface");

721

else

721

else

722

SocExplorerEngine::message(this->plugin,"Device is an interface: " + QString::number(deviceIsAnInterface) + " (1 => true, 0 => false)");

722

SocExplorerEngine::message(this->plugin,"Device is an interface: " + QString::number(deviceIsAnInterface) + " (1 => true, 0 => false)");

723

724

setRoutingTableEntry(0xfe, 0x02, 0); // [0010] => route 0xfe on port 1

724

setRoutingTableEntry(0xfe, 0x02, 0); // [0010] => route 0xfe on port 1

725

setRoutingTableEntry(32 , 0x08, 0); // [1000] => route 32 on port 3

725

setRoutingTableEntry(32 , 0x08, 0); // [1000] => route 32 on port 3

726

727

USBSpaceWire_RegisterReceiveOnAllPorts(hDevice); // Register to receive on port 1 only

727

USBSpaceWire_RegisterReceiveOnAllPorts(hDevice); // Register to receive on port 1 only

728

USBSpaceWire_ClearEndpoints(hDevice); // clear the USB endpoints

728

USBSpaceWire_ClearEndpoints(hDevice); // clear the USB endpoints

729

730

SocExplorerEngine::message(this->plugin,"The driver's current send buffer size is " + QString::number(USBSpaceWire_GetDriverSendBufferSize(hDevice)) + " bytes");

730

SocExplorerEngine::message(this->plugin,"The driver's current send buffer size is " + QString::number(USBSpaceWire_GetDriverSendBufferSize(hDevice)) + " bytes");

731

SocExplorerEngine::message(this->plugin,"The driver's current read buffer size is " + QString::number(USBSpaceWire_GetDriverReadBufferSize(hDevice)) + " bytes");

731

SocExplorerEngine::message(this->plugin,"The driver's current read buffer size is " + QString::number(USBSpaceWire_GetDriverReadBufferSize(hDevice)) + " bytes");

732

SocExplorerEngine::message(this->plugin,"USBSpaceWire_IsReadThrottling is " + QString::number(USBSpaceWire_IsReadThrottling(hDevice)));

732

SocExplorerEngine::message(this->plugin,"USBSpaceWire_IsReadThrottling is " + QString::number(USBSpaceWire_IsReadThrottling(hDevice)));

733

734

//************

734

//************

735

// test Link 1 and Link 2

735

// test Link 1 and Link 2

736

linkStatus1 = getLinkStatus(0x01);

736

linkStatus1 = getLinkStatus(0x01);

737

linkStatus2 = getLinkStatus(0x02);

737

linkStatus2 = getLinkStatus(0x02);

738

this->handleMutex->unlock();

738

this->handleMutex->unlock();

739

740

if ((linkStatus1==1) || (linkStatus2==1))

740

if ((linkStatus1==1) || (linkStatus2==1))

741

{

741

{

742

initializeTimecodeGeneration();

742

initializeTimecodeGeneration();

743

this->connected=true;

743

this->connected=true;

744

return true;

744

return true;

745

}

745

}

746

else

746

else

747

{

747

{

748

statusLink1->setText("Link 1 status code: " + QString::number(linkStatus1));

748

statusLink1->setText("Link 1 status code: " + QString::number(linkStatus1));

749

statusLink2->setText("Link 2 status code: " + QString::number(linkStatus2));

749

statusLink2->setText("Link 2 status code: " + QString::number(linkStatus2));

750

starDundeeStatusQueryDialog->exec();

750

starDundeeStatusQueryDialog->exec();

751

this->connected = false;

751

this->connected = false;

752

return false;

752

return false;

753

}

753

}

754

}

754

}

755

756

void stardundeeSPW_USB_Manager::initDialog( void )

756

void stardundeeSPW_USB_Manager::initDialog( void )

757

{

757

{

758

// STAR DUNDEE STATUS QUERY DIALOG

758

// STAR DUNDEE STATUS QUERY DIALOG

759

starDundeeStatusQueryDialog = new QDialog;

759

starDundeeStatusQueryDialog = new QDialog;

760

starDundeeStatusQueryDialogLayout = new QGridLayout;

760

starDundeeStatusQueryDialogLayout = new QGridLayout;

761

starDundeeStatusQueryDialogLabel = new QLabel(tr("SpaceWire links state"));

761

starDundeeStatusQueryDialogLabel = new QLabel(tr("SpaceWire links state"));

762

starDundeeStatusQueryContinueButton = new QPushButton(tr("Continue"));

762

starDundeeStatusQueryContinueButton = new QPushButton(tr("Continue"));

763

starDundeeStatusQueryRetryButton = new QPushButton(tr("Retry"));

763

starDundeeStatusQueryRetryButton = new QPushButton(tr("Retry"));

764

starDundeeStatusQueryAbortButton = new QPushButton(tr("Abort"));

764

starDundeeStatusQueryAbortButton = new QPushButton(tr("Abort"));

765

statusLink1 = new QLabel(tr("Link 1 status code: -"));

765

statusLink1 = new QLabel(tr("Link 1 status code: -"));

766

statusLink2 = new QLabel(tr("Link 2 status code: -"));

766

statusLink2 = new QLabel(tr("Link 2 status code: -"));

767

768

starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryDialogLabel, 0, 0, 1, 2);

768

starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryDialogLabel, 0, 0, 1, 2);

769

starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryContinueButton, 1, 0, 0);

769

starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryContinueButton, 1, 0, 0);

770

starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryRetryButton, 1, 1, 0);

770

starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryRetryButton, 1, 1, 0);

771

starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryAbortButton, 1, 2, 0);

771

starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryAbortButton, 1, 2, 0);

772

starDundeeStatusQueryDialogLayout->addWidget(statusLink1, 2, 0, 0);

772

starDundeeStatusQueryDialogLayout->addWidget(statusLink1, 2, 0, 0);

773

starDundeeStatusQueryDialogLayout->addWidget(statusLink2, 3, 0, 0);

773

starDundeeStatusQueryDialogLayout->addWidget(statusLink2, 3, 0, 0);

774

starDundeeStatusQueryDialog->setLayout(starDundeeStatusQueryDialogLayout);

774

starDundeeStatusQueryDialog->setLayout(starDundeeStatusQueryDialogLayout);

775

}

775

}

776

777

unsigned char stardundeeSPW_USB_Manager::setRoutingTableEntry(int tableEntry, U32 dwOutputPorts, char bDelHead)

777

unsigned char stardundeeSPW_USB_Manager::setRoutingTableEntry(int tableEntry, U32 dwOutputPorts, char bDelHead)

778

{

778

{

779

U32 routingTableEntry;

779

U32 routingTableEntry;

780

// SET THE ROUTING TABLE ENTRY FOR LOGICAL ADDRESSING, TARGET entryNumber

780

// SET THE ROUTING TABLE ENTRY FOR LOGICAL ADDRESSING, TARGET entryNumber

781

if (CFGSpaceWire_ClearRoutingTableEntry(hDevice, tableEntry) != CFG_TRANSFER_SUCCESS)

781

if (CFGSpaceWire_ClearRoutingTableEntry(hDevice, tableEntry) != CFG_TRANSFER_SUCCESS)

782

{

782

{

783

SocExplorerEngine::message(this->plugin,"Could not clear routing table entry " + QString::number(tableEntry));

783

SocExplorerEngine::message(this->plugin,"Could not clear routing table entry " + QString::number(tableEntry));

784

}

784

}

785

// Build the routing table entry

785

// Build the routing table entry

786

CFGSpaceWire_RTBuildRoutingTableEntry(&routingTableEntry,

786

CFGSpaceWire_RTBuildRoutingTableEntry(&routingTableEntry,

787

dwOutputPorts, // route out of port dwOutputPorts

787

dwOutputPorts, // route out of port dwOutputPorts

788

bDelHead, // header deletion is enabled [1] or disabled [0]

788

bDelHead, // header deletion is enabled [1] or disabled [0]

789

0); // priority normal

789

0); // priority normal

790

// Set the routing table entry for logical address tableEntry

790

// Set the routing table entry for logical address tableEntry

791

if (CFGSpaceWire_SetRoutingTableEntry(hDevice, tableEntry, routingTableEntry) != CFG_TRANSFER_SUCCESS)

791

if (CFGSpaceWire_SetRoutingTableEntry(hDevice, tableEntry, routingTableEntry) != CFG_TRANSFER_SUCCESS)

792

{

792

{

793

SocExplorerEngine::message(this->plugin,"Could not set routing table entry [" + QString::number(tableEntry) + "]");

793

SocExplorerEngine::message(this->plugin,"Could not set routing table entry [" + QString::number(tableEntry) + "]");

794

}

794

}

795

else SocExplorerEngine::message(this->plugin,"Routing table entry [" + QString::number(tableEntry) + "] set" );

795

else SocExplorerEngine::message(this->plugin,"Routing table entry [" + QString::number(tableEntry) + "] set" );

796

return 1;

796

return 1;

797

}

797

}

798

799

unsigned int stardundeeSPW_USB_Manager::getRoutingTableEntry(int tableEntry)

799

unsigned int stardundeeSPW_USB_Manager::getRoutingTableEntry(int tableEntry)

800

{

800

{

801

U32 routingTableEntry, outputPorts;

801

U32 routingTableEntry, outputPorts;

802

char enabled, delHead, priority;

802

char enabled, delHead, priority;

803

int portNum;

803

int portNum;

804

805

SocExplorerEngine::message(this->plugin,"GetRoutingTableEntry [" + QString::number(tableEntry) + "]");

805

SocExplorerEngine::message(this->plugin,"GetRoutingTableEntry [" + QString::number(tableEntry) + "]");

806

// Read the routing table entry

806

// Read the routing table entry

807

if (CFGSpaceWire_GetRoutingTableEntry(hDevice, tableEntry, &routingTableEntry) != CFG_TRANSFER_SUCCESS)

807

if (CFGSpaceWire_GetRoutingTableEntry(hDevice, tableEntry, &routingTableEntry) != CFG_TRANSFER_SUCCESS)

808

{

808

{

809

SocExplorerEngine::message(this->plugin,"Could not read routing table entry [" + QString::number(tableEntry) + "]");

809

SocExplorerEngine::message(this->plugin,"Could not read routing table entry [" + QString::number(tableEntry) + "]");

810

}

810

}

811

else

811

else

812

{

812

{

813

// Display the routing table entry properties

813

// Display the routing table entry properties

814

CFGSpaceWire_RTIsEnabled(routingTableEntry, &enabled);

814

CFGSpaceWire_RTIsEnabled(routingTableEntry, &enabled);

815

CFGSpaceWire_RTIsDelHead(routingTableEntry, &delHead);

815

CFGSpaceWire_RTIsDelHead(routingTableEntry, &delHead);

816

CFGSpaceWire_RTIsPriority(routingTableEntry, &priority);

816

CFGSpaceWire_RTIsPriority(routingTableEntry, &priority);

817

CFGSpaceWire_RTGetOutputPorts(routingTableEntry, &outputPorts);

817

CFGSpaceWire_RTGetOutputPorts(routingTableEntry, &outputPorts);

818

SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsEnabled : " + QString::number(enabled));

818

SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsEnabled : " + QString::number(enabled));

819

SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsDelHead : " + QString::number(delHead));

819

SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsDelHead : " + QString::number(delHead));

820

SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsPriority : " + QString::number(priority));

820

SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsPriority : " + QString::number(priority));

821

SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTGetOutputPorts : ");

821

SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTGetOutputPorts : ");

822

for (portNum = 0; portNum < 32; portNum++)

822

for (portNum = 0; portNum < 32; portNum++)

823

{

823

{

824

if (outputPorts & (1 << portNum))

824

if (outputPorts & (1 << portNum))

825

{

825

{

826

SocExplorerEngine::message(this->plugin,QString::number(portNum));

826

SocExplorerEngine::message(this->plugin,QString::number(portNum));

827

}

827

}

828

}

828

}

829

}

829

}

830

831

return 1;

831

return 1;

832

}

832

}

833

834

void stardundeeSPW_USB_Manager::initializeTimecodeGeneration()

834

void stardundeeSPW_USB_Manager::initializeTimecodeGeneration()

835

{

835

{

836

U32 dwTickEnableStatus;

836

U32 dwTickEnableStatus;

837

U32 rtr_clk_freq;

837

U32 rtr_clk_freq;

838

839

// (1) RESET

839

// (1) RESET

840

if (!USBSpaceWire_TC_Reset(hDevice))

840

if (!USBSpaceWire_TC_Reset(hDevice))

841

SocExplorerEngine::message(this->plugin,"ERR *** in Open *** Could not reset timecodes\n");

841

SocExplorerEngine::message(this->plugin,"ERR *** in Open *** Could not reset timecodes\n");

842

843

// (2) Clear the tick enable register

843

// (2) Clear the tick enable register

844

if (CFGSpaceWire_SetTickEnableStatus(hDevice, 6) != CFG_TRANSFER_SUCCESS)

844

if (CFGSpaceWire_SetTickEnableStatus(hDevice, 6) != CFG_TRANSFER_SUCCESS)

845

SocExplorerEngine::message(this->plugin,"Could not clear the tick enable register");

845

SocExplorerEngine::message(this->plugin,"Could not clear the tick enable register");

846

else

846

else

847

SocExplorerEngine::message(this->plugin,"Cleared the tick enable register");

847

SocExplorerEngine::message(this->plugin,"Cleared the tick enable register");

848

849

// (3) get the tick status

849

// (3) get the tick status

850

CFGSpaceWire_GetTickEnableStatus(hDevice, &dwTickEnableStatus);

850

CFGSpaceWire_GetTickEnableStatus(hDevice, &dwTickEnableStatus);

851

SocExplorerEngine::message(this->plugin,"OK *** in Open *** CFGSpaceWire_GetTickEnableStatus, code is " + QString::number(dwTickEnableStatus, 2));

851

SocExplorerEngine::message(this->plugin,"OK *** in Open *** CFGSpaceWire_GetTickEnableStatus, code is " + QString::number(dwTickEnableStatus, 2));

852

853

// (4) enable external timecode selection

853

// (4) enable external timecode selection

854

if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,0))

854

if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,0))

855

SocExplorerEngine::message(this->plugin,"ERR *** disable external timecode selection");

855

SocExplorerEngine::message(this->plugin,"ERR *** disable external timecode selection");

856

857

rtr_clk_freq = USBSpaceWire_TC_GetClockFrequency(hDevice);

857

rtr_clk_freq = USBSpaceWire_TC_GetClockFrequency(hDevice);

858

859

SocExplorerEngine::message(this->plugin,"clock frequency = " + QString::number(rtr_clk_freq) );

859

SocExplorerEngine::message(this->plugin,"clock frequency = " + QString::number(rtr_clk_freq) );

860

861

//**************************************************

861

//**************************************************

862

// auto _ tick _ freq = rtr _ clk _ freq / freqCount

862

// auto _ tick _ freq = rtr _ clk _ freq / freqCount

863

if (!USBSpaceWire_TC_SetAutoTickInFrequency(hDevice, rtr_clk_freq) )

863

if (!USBSpaceWire_TC_SetAutoTickInFrequency(hDevice, rtr_clk_freq) )

864

SocExplorerEngine::message(this->plugin,"Could not set the tick-in frequency");

864

SocExplorerEngine::message(this->plugin,"Could not set the tick-in frequency");

865

}

865

}

866

867

unsigned int stardundeeSPW_USB_Manager::getLinkStatus(unsigned char link)

867

unsigned int stardundeeSPW_USB_Manager::getLinkStatus(unsigned char link)

868

{

868

{

869

U32 statusControl, errorStatus, portType;

869

U32 statusControl, errorStatus, portType;

870

U32 linkStatus, operatingSpeed, outputPortConnection;

870

U32 linkStatus, operatingSpeed, outputPortConnection;

871

char isLinkRunning, isAutoStart, isStart, isDisabled, isTristate;

871

char isLinkRunning, isAutoStart, isStart, isDisabled, isTristate;

872

873

// Read the link status control register

873

// Read the link status control register

874

if (CFGSpaceWire_GetLinkStatusControl(hDevice, link, &statusControl) != CFG_TRANSFER_SUCCESS)

874

if (CFGSpaceWire_GetLinkStatusControl(hDevice, link, &statusControl) != CFG_TRANSFER_SUCCESS)

875

{

875

{

876

SocExplorerEngine::message(this->plugin,"Could not read link status control for link" + QString::number(link));

876

SocExplorerEngine::message(this->plugin,"Could not read link status control for link" + QString::number(link));

877

}

877

}

878

else

878

else

879

{

879

{

880

// Display the link status control register properties

880

// Display the link status control register properties

881

CFGSpaceWire_LSPortType(statusControl, &portType);

881

CFGSpaceWire_LSPortType(statusControl, &portType);

882

if (portType == CFG_CONFIGURATION_PORT)

882

if (portType == CFG_CONFIGURATION_PORT)

883

{

883

{

884

CFGSpaceWire_LSConfigErrorStatus(statusControl, &errorStatus);

884

CFGSpaceWire_LSConfigErrorStatus(statusControl, &errorStatus);

885

}

885

}

886

else if (portType == CFG_SPACEWIRE_EXTERNAL_PORT)

886

else if (portType == CFG_SPACEWIRE_EXTERNAL_PORT)

887

{

887

{

888

CFGSpaceWire_LSExternalErrorStatus(statusControl, &errorStatus);

888

CFGSpaceWire_LSExternalErrorStatus(statusControl, &errorStatus);

889

}

889

}

890

else

890

else

891

{

891

{

892

CFGSpaceWire_LSErrorStatus(statusControl, &errorStatus);

892

CFGSpaceWire_LSErrorStatus(statusControl, &errorStatus);

893

}

893

}

894

CFGSpaceWire_LSLinkState(statusControl, &linkStatus);

894

CFGSpaceWire_LSLinkState(statusControl, &linkStatus);

895

CFGSpaceWire_LSIsLinkRunning(statusControl, &isLinkRunning);

895

CFGSpaceWire_LSIsLinkRunning(statusControl, &isLinkRunning);

896

CFGSpaceWire_LSIsAutoStart(statusControl, &isAutoStart);

896

CFGSpaceWire_LSIsAutoStart(statusControl, &isAutoStart);

897

CFGSpaceWire_LSIsStart(statusControl, &isStart);

897

CFGSpaceWire_LSIsStart(statusControl, &isStart);

898

CFGSpaceWire_LSIsDisabled(statusControl, &isDisabled);

898

CFGSpaceWire_LSIsDisabled(statusControl, &isDisabled);

899

CFGSpaceWire_LSIsTristate(statusControl, &isTristate);

899

CFGSpaceWire_LSIsTristate(statusControl, &isTristate);

900

CFGSpaceWire_LSOperatingSpeed(statusControl, &operatingSpeed);

900

CFGSpaceWire_LSOperatingSpeed(statusControl, &operatingSpeed);

901

CFGSpaceWire_LSOutputPortConnection(statusControl, &outputPortConnection);

901

CFGSpaceWire_LSOutputPortConnection(statusControl, &outputPortConnection);

902

}

902

}

903

SocExplorerEngine::message(this->plugin,"status of link " + QString::number(link)

903

SocExplorerEngine::message(this->plugin,"status of link " + QString::number(link)

904

+" is " + dwLinkStatusQString[linkStatus]);

904

+" is " + dwLinkStatusQString[linkStatus]);

905

if (linkStatus == 5)

905

if (linkStatus == 5)

906

{

906

{

907

return 1;

907

return 1;

908

}

908

}

909

else return 0;

909

else return 0;

910

}

910

}

911

912

bool stardundeeSPW_USB_Manager::disconnectBridge()

912

bool stardundeeSPW_USB_Manager::disconnectBridge()

913

{

913

{

914

this->handleMutex->lock();

914

this->handleMutex->lock();

915

USBSpaceWire_Close(hDevice); // Close the device

915

USBSpaceWire_Close(hDevice); // Close the device

916

SocExplorerEngine::message(this->plugin,"stardundee *** Close *** USBSpaceWire_Close, device: " + QString::number(0),0);

916

SocExplorerEngine::message(this->plugin,"stardundee *** Close *** USBSpaceWire_Close, device: " + QString::number(0),0);

917

USBSpaceWire_UnregisterReceiveOnAllPorts(hDevice); // Stop receiving on all ports

917

USBSpaceWire_UnregisterReceiveOnAllPorts(hDevice); // Stop receiving on all ports

918

this->handleMutex->unlock();

918

this->handleMutex->unlock();

919

this->RMAP_pending_transaction_IDsMtx->lock();

919

this->RMAP_pending_transaction_IDsMtx->lock();

920

this->RMAP_pending_transaction_IDs.clear();

920

this->RMAP_pending_transaction_IDs.clear();

921

this->RMAP_pending_transaction_IDsMtx->unlock();

921

this->RMAP_pending_transaction_IDsMtx->unlock();

922

this->RMAP_AnswersMtx->lock();

922

this->RMAP_AnswersMtx->lock();

923

this->RMAP_Answers.clear();

923

this->RMAP_Answers.clear();

924

this->RMAP_AnswersMtx->unlock();

924

this->RMAP_AnswersMtx->unlock();

925

this->RMAP_AnswersSem->acquire(this->RMAP_AnswersSem->available());

925

this->RMAP_AnswersSem->acquire(this->RMAP_AnswersSem->available());

926

return true;

926

return true;

927

}

927

}

928

929

int stardundeeSPW_USB_Manager::getRMAPtransactionID()

929

int stardundeeSPW_USB_Manager::getRMAPtransactionID()

930

{

930

{

931

this->RMAP_pending_transaction_IDsMtx->lock();

931

this->RMAP_pending_transaction_IDsMtx->lock();

932

int ID=0;

932

int ID=0;

933

bool found=true;

933

bool found=true;

934

while(ID<511)

934

while(ID<511)

935

{

935

{

936

for(int i=0;i<RMAP_pending_transaction_IDs.count();i++)

936

for(int i=0;i<RMAP_pending_transaction_IDs.count();i++)

937

{

937

{

938

if(RMAP_pending_transaction_IDs[i]==ID)found=false;

938

if(RMAP_pending_transaction_IDs[i]==ID)found=false;

939

}

939

}

940

if(found==true)break;

940

if(found==true)break;

941

ID++;

941

ID++;

942

found = true;

942

found = true;

943

}

943

}

944

if(found)

944

if(found)

945

{

945

{

946

RMAP_pending_transaction_IDs.append(ID);

946

RMAP_pending_transaction_IDs.append(ID);

947

}

947

}

948

this->RMAP_pending_transaction_IDsMtx->unlock();

948

this->RMAP_pending_transaction_IDsMtx->unlock();

949

return ID;

949

return ID;

950

}

950

}

951

952

int stardundeeSPW_USB_Manager::getRMAPanswer(int transactionID, char **buffer)

952

int stardundeeSPW_USB_Manager::getRMAPanswer(int transactionID, char **buffer)

953

{

953

{

954

QTime timeout;

954

QTime timeout;

955

*buffer=NULL;

955

*buffer=NULL;

956

int count=0;

956

int count=0;

957

SocExplorerEngine::message(this->plugin,"Looking for RMAP answer",2);

957

SocExplorerEngine::message(this->plugin,"Looking for RMAP answer",2);

958

timeout.start();

958

timeout.start();

959

while (*buffer==NULL)

959

while (*buffer==NULL)

960

{

960

{

961

this->RMAP_AnswersMtx->lock();

961

this->RMAP_AnswersMtx->lock();

962

SocExplorerEngine::message(this->plugin,"Got exclusive access on RMAP_Answers stack",2);

962

SocExplorerEngine::message(this->plugin,"Got exclusive access on RMAP_Answers stack",2);

963

SocExplorerEngine::message(this->plugin,QString("%1 packet(s) available in RMAP_Answers stack").arg(RMAP_Answers.count()),2);

963

SocExplorerEngine::message(this->plugin,QString("%1 packet(s) available in RMAP_Answers stack").arg(RMAP_Answers.count()),2);

964

for(int i=0;i<RMAP_Answers.count();i++)

964

for(int i=0;i<RMAP_Answers.count();i++)

965

{

965

{

966

SocExplorerEngine::message(this->plugin,QString("Packet %1 ID=%2").arg(i).arg(RMAP_Answers[i]->transactionID),2);

966

SocExplorerEngine::message(this->plugin,QString("Packet %1 ID=%2").arg(i).arg(RMAP_Answers[i]->transactionID),2);

967

if(RMAP_Answers[i]->transactionID==transactionID)

967

if(RMAP_Answers[i]->transactionID==transactionID)

968

{

968

{

969

this->RMAP_pending_transaction_IDsMtx->lock();

969

this->RMAP_pending_transaction_IDsMtx->lock();

970

SocExplorerEngine::message(this->plugin,"Got exclusive access on RMAP_pending_transaction_ID stack",2);

970

SocExplorerEngine::message(this->plugin,"Got exclusive access on RMAP_pending_transaction_ID stack",2);

971

for(int j=0;j<RMAP_pending_transaction_IDs.count();j++)

971

for(int j=0;j<RMAP_pending_transaction_IDs.count();j++)

972

{

972

{

973

if(RMAP_pending_transaction_IDs[j]==transactionID)

973

if(RMAP_pending_transaction_IDs[j]==transactionID)

974

{

974

{

975

RMAP_pending_transaction_IDs.removeAt(j);

975

RMAP_pending_transaction_IDs.removeAt(j);

976

}

976

}

977

}

977

}

978

this->RMAP_pending_transaction_IDsMtx->unlock();

978

this->RMAP_pending_transaction_IDsMtx->unlock();

979

*buffer = RMAP_Answers[i]->data;

979

*buffer = RMAP_Answers[i]->data;

980

count = RMAP_Answers[i]->len;

980

count = RMAP_Answers[i]->len;

981

RMAP_Answer* tmp=RMAP_Answers[i];

981

RMAP_Answer* tmp=RMAP_Answers[i];

982

RMAP_Answers.removeAt(i);

982

RMAP_Answers.removeAt(i);

983

delete tmp;

983

delete tmp;

984

}

984

}

985

}

985

}

986

this->RMAP_AnswersMtx->unlock();

986

this->RMAP_AnswersMtx->unlock();

987

//if no answer found in the stack wait until a new packet is pushed

987

//if no answer found in the stack wait until a new packet is pushed

988

SocExplorerEngine::message(this->plugin,"waiting until a new packet is pushed",2);

988

SocExplorerEngine::message(this->plugin,"waiting until a new packet is pushed",2);

989

if(*buffer==NULL)

989

if(*buffer==NULL)

990

{

990

{

991

while (0==this->RMAP_AnswersSem->available())

991

while (0==this->RMAP_AnswersSem->available())

992

{

992

{

993

SocExplorerEngine::message(this->plugin,QString("this->RMAP_AnswersSem->available() = %1").arg(this->RMAP_AnswersSem->available()),2);

993

SocExplorerEngine::message(this->plugin,QString("this->RMAP_AnswersSem->available() = %1").arg(this->RMAP_AnswersSem->available()),2);

994

if(timeout.elapsed()>=RMAPtimeout)

994

if(timeout.elapsed()>=RMAPtimeout)

995

{

995

{

996

SocExplorerEngine::message(this->plugin,"Timeout reached giving up!",2);

996

SocExplorerEngine::message(this->plugin,"Timeout reached giving up!",2);

997

return -1;

997

return -1;

998

}

998

}

999

usleep(1000);

999

usleep(1000);

1000

}

1000

}

1001

this->RMAP_AnswersSem->acquire();

1001

this->RMAP_AnswersSem->acquire();

1002

}

1002

}

1003

}

1003

}

1004

return count;

1004

return count;

1005

}

1005

}

1006

1007

bool stardundeeSPW_USB_Manager::sendPacket(char *packet, int size)

1007

bool stardundeeSPW_USB_Manager::sendPacket(char *packet, int size)

1008

{

1008

{

1009

char protocoleIdentifier;

1009

char protocoleIdentifier;

1010

USB_SPACEWIRE_STATUS result=TRANSFER_ERROR_NOT_FOUND;

1010

USB_SPACEWIRE_STATUS result=TRANSFER_ERROR_NOT_FOUND;

1011

USB_SPACEWIRE_ID pIdentifier;

1011

USB_SPACEWIRE_ID pIdentifier;

1012

SocExplorerEngine::message(this->plugin,"Sending SPW packet",2);

1012

SocExplorerEngine::message(this->plugin,"Sending SPW packet",2);

1013

this->handleMutex->lock();

1013

this->handleMutex->lock();

1014

result = USBSpaceWire_SendPacket(hDevice,packet,size,1, &pIdentifier);

1014

result = USBSpaceWire_SendPacket(hDevice,packet,size,1, &pIdentifier);

1015

USBSpaceWire_FreeSend(hDevice, pIdentifier);

1015

USBSpaceWire_FreeSend(hDevice, pIdentifier);

1016

this->handleMutex->unlock();

1016

this->handleMutex->unlock();

1017

if (result != TRANSFER_SUCCESS)

1017

if (result != TRANSFER_SUCCESS)

1018

{

1018

{

1019

SocExplorerEngine::message(this->plugin,"ERR sending the READ command ",2);

1019

SocExplorerEngine::message(this->plugin,"ERR sending the READ command ",2);

1020

return false;

1020

return false;

1021

}

1021

}

1022

else

1022

else

1023

{

1023

{

1024

emit bytesTransmittedToSpw( size-1 ); // -1 is for removing the first bytes added to the packet to route to the right link

1024

emit bytesTransmittedToSpw( size-1 ); // -1 is for removing the first bytes added to the packet to route to the right link

1025

// read the protocole identifier

1025

// read the protocole identifier

1026

protocoleIdentifier = packet[2];

1026

protocoleIdentifier = packet[2];

1027

if (protocoleIdentifier == SPW_PROTO_ID_CCSDS)

1027

if (protocoleIdentifier == SPW_PROTO_ID_CCSDS)

1028

emit ccsdsPacketTransmittedToSpw();

1028

emit ccsdsPacketTransmittedToSpw();

1029

1030

SocExplorerEngine::message(this->plugin,"Packet sent",2);

1030

SocExplorerEngine::message(this->plugin,"Packet sent",2);

1031

}

1031

}

1032

// this->handleMutex->unlock();

1033

return true;

1032

return true;

1034

}

1033

}

1035

1034

1036

void stardundeeSPW_USB_Manager::pushRmapPacket(char *packet, int len)

1035

void stardundeeSPW_USB_Manager::pushRmapPacket(char *packet, int len)

1037

{

1036

{

1038

char* packetbuffer = (char*)malloc(len);

1037

char* packetbuffer = (char*)malloc(len);

1039

memcpy(packetbuffer,packet,len);

1038

memcpy(packetbuffer,packet,len);

1040

RMAP_Answer* RMPAPpacket=new RMAP_Answer(RMAP_get_transactionID(packetbuffer+1),packetbuffer,len);

1039

RMAP_Answer* RMPAPpacket=new RMAP_Answer(RMAP_get_transactionID(packetbuffer+1),packetbuffer,len);

1041

RMAP_AnswersMtx->lock();

1040

RMAP_AnswersMtx->lock();

1042

RMAP_Answers.append(RMPAPpacket);

1041

RMAP_Answers.append(RMPAPpacket);

1043

RMAP_AnswersMtx->unlock();

1042

RMAP_AnswersMtx->unlock();

1044

}

1043

}

1045

1044

1046

void stardundeeSPW_USB_Manager::sendTimecodePeriodically( bool onOff )

1045

void stardundeeSPW_USB_Manager::sendTimecodePeriodically( bool onOff )

1047

{

1046

{

1047

this->handleMutex->lock();

1048

if (onOff == true)

1048

if (onOff == true)

1049

{

1049

{

1050

if (!USBSpaceWire_TC_EnableAutoTickIn(hDevice, 1, 1))

1050

if (!USBSpaceWire_TC_EnableAutoTickIn(hDevice, 1, 1))

1051

SocExplorerEngine::message(this->plugin,"Could not enable auto tick-in");

1051

SocExplorerEngine::message(this->plugin,"Could not enable auto tick-in");

1052

}

1052

}

1053

else

1053

else

1054

{

1054

{

1055

if (!USBSpaceWire_TC_EnableAutoTickIn(hDevice, 0, 0))

1055

if (!USBSpaceWire_TC_EnableAutoTickIn(hDevice, 0, 0))

1056

SocExplorerEngine::message(this->plugin,"Could not disable auto tick-in");

1056

SocExplorerEngine::message(this->plugin,"Could not disable auto tick-in");

1057

}

1057

}

1058

this->handleMutex->unlock();

1058

}

1059

}

1059

1060

int stardundeeSPW_USB_Manager::getLinkNumber( void )

1061

int stardundeeSPW_USB_Manager::getLinkNumber( void )

1061

{

1062

{

1062

return this->linkNumber;

1063

return this->linkNumber;

1063

}

1064

}

1064

1065

void stardundeeSPW_USB_Manager::setTimecodeFrequency(double requestedFrequency)

1066

void stardundeeSPW_USB_Manager::setTimecodeFrequency(double requestedFrequency)

1066

{

1067

{

1067

U32 rtr_clk_freq=0;

1068

U32 rtr_clk_freq=0;

1068

U32 freqCount=0;

1069

U32 freqCount=0;

1069

double freqCountInDouble=0.0;

1070

double freqCountInDouble=0.0;

1070

double currentFrequency=0.0;

1071

double currentFrequency=0.0;

1071

1072

1073

this->handleMutex->lock();

1072

rtr_clk_freq = USBSpaceWire_TC_GetClockFrequency(hDevice);

1074

rtr_clk_freq = USBSpaceWire_TC_GetClockFrequency(hDevice);

1073

freqCountInDouble = ((double) rtr_clk_freq) / requestedFrequency;

1075

freqCountInDouble = ((double) rtr_clk_freq) / requestedFrequency;

1074

freqCount = (unsigned int) freqCountInDouble;

1076

freqCount = (unsigned int) freqCountInDouble;

1075

1077

1076

currentFrequency = ((double) rtr_clk_freq) / ((double) freqCount);

1078

currentFrequency = ((double) rtr_clk_freq) / ((double) freqCount);

1077

1079

1078

//**************************************************

1080

//**************************************************

1079

// auto _ tick _ freq = rtr _ clk _ freq / freqCount

1081

// auto _ tick _ freq = rtr _ clk _ freq / freqCount

1080

if (!USBSpaceWire_TC_SetAutoTickInFrequency(hDevice, freqCount) )

1082

if (!USBSpaceWire_TC_SetAutoTickInFrequency(hDevice, freqCount) )

1081

SocExplorerEngine::message(this->plugin,"Could not set the tick-in frequency");

1083

SocExplorerEngine::message(this->plugin,"Could not set the tick-in frequency");

1082

else

1084

else

1083

SocExplorerEngine::message(this->plugin,"tick frequency set to " + QString::number(currentFrequency) +" Hz"

1085

SocExplorerEngine::message(this->plugin,"tick frequency set to " + QString::number(currentFrequency) +" Hz"

1084

+ " (freqCount set to " + QString::number(freqCount) + ")" );

1086

+ " (freqCount set to " + QString::number(freqCount) + ")" );

1087

this->handleMutex->unlock();

1085

}

1088

}

1086

1089

1087

void stardundeeSPW_USB_Manager::sendOneTimecode( unsigned char nTimein )

1090

void stardundeeSPW_USB_Manager::sendOneTimecode( unsigned char nTimein )

1088

{

1091

{

1092

this->handleMutex->lock();

1089

// enable external timecode selection

1093

// enable external timecode selection

1090

if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,1))

1094

if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,1))

1091

SocExplorerEngine::message(this->plugin,"sendOneTimecode *** ERR *** enable external timecode selection");

1095

SocExplorerEngine::message(this->plugin,"sendOneTimecode *** ERR *** enable external timecode selection");

1092

1096

1093

if (!USBSpaceWire_TC_PerformTickIn( hDevice, nTimein) )

1097

if (!USBSpaceWire_TC_PerformTickIn( hDevice, nTimein) )

1094

SocExplorerEngine::message( this->plugin,"sendOneTimecode *** ERR *** Could not send the requested timecode: " + QString::number(nTimein) );

1098

SocExplorerEngine::message( this->plugin,"sendOneTimecode *** ERR *** Could not send the requested timecode: " + QString::number(nTimein) );

1095

else

1099

else

1096

SocExplorerEngine::message( this->plugin,"sendOneTimecode *** OK *** timecode sent " + QString::number(nTimein) );

1100

SocExplorerEngine::message( this->plugin,"sendOneTimecode *** OK *** timecode sent " + QString::number(nTimein) );

1097

1101

1098

// disable external timecode selection

1102

// disable external timecode selection

1099

if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,0))

1103

if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,0))

1100

SocExplorerEngine::message(this->plugin,"sendOneTimecode *** ERR *** disable external timecode selection");

1104

SocExplorerEngine::message(this->plugin,"sendOneTimecode *** ERR *** disable external timecode selection");

1105

this->handleMutex->unlock();

1101

}

1106

}

1102

1107

1103

1108

	Site-wide shortcuts
/	Use quick search box
g h	Goto home page
g g	Goto my private gists page
g G	Goto my public gists page
g 0-9	Goto bookmarked items from 0-9
n r	New repository page
n g	New gist page

	Repositories
g s	Goto summary page
g c	Goto changelog page
g f	Goto files page
g F	Goto files page with file search activated
g p	Goto pull requests page
g o	Goto repository settings
g O	Goto repository access permissions settings
t s	Toggle sidebar on some pages

             /*------------------------------------------------------------------------------
             --  This file is a part of the SocExplorer Software
             --  Copyright (C) 2014, Plasma Physics Laboratory - CNRS
             --
             --  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@member.fsf.org
             ----------------------------------------------------------------------------*/
             #include "stardundeespw_usb.h"
             #include "fakestardundeespwusb_lib.h"
             #include <socexplorerengine.h>
             #include <qhexedit.h>
             QString dwLinkStatusQString[6] = {
                 "CFG_SPACEWIRE_ERROR_RESET",
                 "CFG_SPACEWIRE_ERROR_WAIT",
                 "CFG_SPACEWIRE_READY",
                 "CFG_SPACEWIRE_STARTED",
                 "CFG_SPACEWIRE_CONNECTING",
                 "CFG_SPACEWIRE_RUN"
             };
             stardundeeSPW_USB::stardundeeSPW_USB(socexplorerplugin *parent) :
                 abstractSpwBridge(parent)
             {
                 Q_UNUSED(parent)
                 this->manager = new stardundeeSPW_USB_Manager(parent,this);
                 makeGUI(parent);
                 this->manager->start();
                 connect(this->manager,SIGNAL(emitPacket(char*,int)),this,SIGNAL(pushPacketOverTCP(char*,int)));
                 connect(this->manager, SIGNAL(bytesReceivedFromSpw(uint)), this, SIGNAL(BytesReceivedFromSpw(uint)));
                 connect(this->manager, SIGNAL(bytesTransmittedToSpw(uint)), this, SIGNAL(BytesTransmittedToSpw(uint)));
                 connect(this->manager, SIGNAL(ccsdsPacketTransmittedToSpw()), this, SIGNAL(CCSDSPacketTransmittedToSpw()));
             }
             stardundeeSPW_USB::~stardundeeSPW_USB()
             {
                 this->manager->requestInterruption();
                 while(this->manager->isRunning());
             }
             void stardundeeSPW_USB::toggleBridgeConnection()
             {
                 if(this->plugin->isConnected())
                 {
                     this->disconnectBridge();
                 }
                 else
                 {
                     this->connectBridge();
                 }
             }
             bool stardundeeSPW_USB::connectBridge()
             {
                 if(this->manager->connectBridge())
                 {
                     this->timecodeFrequencyChanged(   ((StarDundeeGUI*)this->p_GUI)->getTimecodeFrequency());
                     this->startSendingTimecodes(      ((StarDundeeGUI*)this->p_GUI)->getStartSendingTimecodes());
                     ((StarDundeeGUI*)this->p_GUI)->lock(true);
                     emit setConnected(true);
                     return true;
                 }
                 return false;
             }
             bool stardundeeSPW_USB::disconnectBridge()
             {
                 if(this->manager->disconnectBridge())
                 {
                     ((StarDundeeGUI*)this->p_GUI)->lock(false);
                     emit setConnected(false);
                     return true;
                 }
                 return false;
             }
             int stardundeeSPW_USB::pushRMAPPacket(char *packet, int size)
             {
                 return this->manager->sendPacket(packet,size);
             }
             unsigned int stardundeeSPW_USB::Write(unsigned int *Value, unsigned int count, unsigned int address)
             {
                 char writeBuffer[RMAP_WRITE_PACKET_MIN_SZ((RMAP_MAX_XFER_SIZE*4))+1];
                 char *RMAPAckBuff;
                 writeBuffer[0]=this->manager->linkNumber;//Link number
                 int transactionID = 0;
                 int written=0;
                 SocExplorerEngine::message(this->plugin,"Enter Write function",2);
                 QProgressBar* progress=NULL;
                 SocExplorerAutoProgressBar autopb;
                 if(count>RMAP_MAX_XFER_SIZE)
                 {
                     progress= SocExplorerEngine::getProgressBar("Writing on SPW @0x"+QString::number(address,16)+" %v of "+QString::number(count)+" words ",count);
                     autopb.setProgressBar(progress);
                 }
                 //Quite stupide loop, I guess that I always get the number of byte I asked for!
                 while(count>=RMAP_MAX_XFER_SIZE)
                 {
                     for(int i=0;i<(RMAP_MAX_XFER_SIZE);i++)
                     {
                         writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+1] = (char)(((unsigned int)Value[i+written]>>24)&0xFF);
                         writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+2] = (char)(((unsigned int)Value[i+written]>>16)&0xFF);
                         writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+3] = (char)(((unsigned int)Value[i+written]>>8)&0xFF);
                         writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+4] = (char)(((unsigned int)Value[i+written])&0xFF);
                     }
                     transactionID=manager->getRMAPtransactionID();
                     SocExplorerEngine::message(this->plugin,QString("Sending Write request with ID=%1").arg(transactionID),2);
                     RMAP_build_tx_request_header(
                                 this->manager->destinationLogicalAddress,
                                 this->manager->destinationKey,
                                 this->manager->sourceLogicalAddress,
                                 transactionID,
                                 address+(written*4),
                                 RMAP_MAX_XFER_SIZE*4,
                                 writeBuffer+1);
                     manager->sendPacket(writeBuffer,RMAP_WRITE_PACKET_MIN_SZ(RMAP_MAX_XFER_SIZE*4)+1);
                     manager->getRMAPanswer(transactionID,&RMAPAckBuff);
                     free(RMAPAckBuff);
                     written+=RMAP_MAX_XFER_SIZE;
                     count-=RMAP_MAX_XFER_SIZE;
                     progress->setValue(written);
                     qApp->processEvents();
                 }
                 if(count>0)
                 {
                     for(int i=0;i<((int)count);i++)
                     {
                         writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+1] = (char)(((unsigned int)Value[i+written]>>24)&0xFF);
                         writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+2] = (char)(((unsigned int)Value[i+written]>>16)&0xFF);
                         writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+3] = (char)(((unsigned int)Value[i+written]>>8)&0xFF);
                         writeBuffer[RMAP_WRITE_HEADER_MIN_SZ+(i*4)+4] = (char)(((unsigned int)Value[i+written])&0xFF);
                     }
                     transactionID=manager->getRMAPtransactionID();
                     SocExplorerEngine::message(this->plugin,QString("Sending Write request with ID=%1").arg(transactionID),2);
                     RMAP_build_tx_request_header(
                                 this->manager->destinationLogicalAddress,
                                 this->manager->destinationKey,
                                 this->manager->sourceLogicalAddress,
                                 transactionID,
                                 address+(written*4),
                                 count*4,
                                 writeBuffer+1);
                     manager->sendPacket(writeBuffer,RMAP_WRITE_PACKET_MIN_SZ(count*4) +1);
                     manager->getRMAPanswer(transactionID,&RMAPAckBuff);
                     free(RMAPAckBuff);
                     written+=count;
                     if(progress!=NULL)
                     {
                         progress->setValue(written);
                         qApp->processEvents();
                     }
                 }
                 return written;
             }
             unsigned int stardundeeSPW_USB::Read(unsigned int *Value, unsigned int count, unsigned int address)
             {
                 char requestBuffer[RMAP_READ_HEADER_MIN_SZ+1];
                 char* RMAP_AnswerBuffer;
                 requestBuffer[0]=this->manager->linkNumber;//Link number
                 int transactionID = 0;
                 int read=0;
                 QProgressBar* progress=NULL;
                 SocExplorerAutoProgressBar autopb;
                 if(count>RMAP_MAX_XFER_SIZE)
                 {
                     progress= SocExplorerEngine::getProgressBar("Reading on SPW @0x"+QString::number(address,16)+" %v of "+QString::number(count)+" words ",count);
                     autopb.setProgressBar(progress);
                 }
                 SocExplorerEngine::message(this->plugin,QString("Enter read function, count=%1, RMAP_MAX_XFER_SIZE=%2").arg(count).arg(RMAP_MAX_XFER_SIZE),2);
                 //Quite stupide loop, I guess that I always get the number of byte I asked for!
                 while((int)count>=(int)RMAP_MAX_XFER_SIZE)
                 {
                     transactionID = manager->getRMAPtransactionID();
                     SocExplorerEngine::message(this->plugin,QString("New transactionID:%1").arg(transactionID),2);
                     RMAP_build_rx_request_header(
                                 this->manager->destinationLogicalAddress,
                                 this->manager->destinationKey,
                                 this->manager->sourceLogicalAddress,
                                 transactionID,
                                 address+(read*4),
                                 RMAP_MAX_XFER_SIZE*4,
                                 requestBuffer+1);
                     manager->sendPacket(requestBuffer,RMAP_READ_HEADER_MIN_SZ+1);
                     int len=manager->getRMAPanswer(transactionID,&RMAP_AnswerBuffer);
                     if(len==-1)
                     {
                         this->toggleBridgeConnection();
                         return 0;
                     }
                     for(int i=0;i<((len-13)/4);i++)
                     {
                         Value[read+i] =   0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+12]);
                         Value[read+i] =  (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+13]));
                         Value[read+i] =  (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+14]));
                         Value[read+i] =  (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+15]));
                     }
                     free(RMAP_AnswerBuffer);
                     read+=RMAP_MAX_XFER_SIZE;
                     count-=RMAP_MAX_XFER_SIZE;
                     progress->setValue(read);
                     qApp->processEvents();
                 }
                 if((int)count>0)
                 {
                     transactionID = manager->getRMAPtransactionID();
                     SocExplorerEngine::message(this->plugin,QString("New transactionID: %1").arg(transactionID),2);
                     SocExplorerEngine::message(this->plugin,QString("Building request with:"),2);
                     SocExplorerEngine::message(this->plugin,QString("Address = %1").arg(address+(read*4),8,16),2);
                     SocExplorerEngine::message(this->plugin,QString("Size = %1").arg(count*4),2);
                     SocExplorerEngine::message(this->plugin,QString("Size + 13 = %1").arg((count*4)+13),2);
                     RMAP_build_rx_request_header(
                                 this->manager->destinationLogicalAddress,
                                 this->manager->destinationKey,
                                 this->manager->sourceLogicalAddress,
                                 transactionID,
                                 address+(read*4),
                                 count*4,
                                 requestBuffer+1);
                     manager->sendPacket(requestBuffer,RMAP_READ_HEADER_MIN_SZ+1);
                     int len=manager->getRMAPanswer(transactionID,&RMAP_AnswerBuffer);
                     if(len==-1)
                     {
                         this->toggleBridgeConnection();
                         return 0;
                     }
                     for(int i=0;i<((len-13)/4);i++)
                     {
                         Value[read+i] =   0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+12]);
                         Value[read+i] =  (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+13]));
                         Value[read+i] =  (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+14]));
                         Value[read+i] =  (Value[read+i]<<8) + (0x0FF & ((unsigned int)RMAP_AnswerBuffer[(4*i)+15]));
                     }
                     free(RMAP_AnswerBuffer);
                     read+=count;
                     if(progress!=NULL)
                     {
                         progress->setValue(read);
                         qApp->processEvents();
                     }
                 }
                 return read;
             }
             void stardundeeSPW_USB::brickSelectionChanged(int brickIndex)
             {
                 this->manager->selectedBrick = brickIndex-1;
                 SocExplorerEngine::message(plugin,QString("Changing brick index: %1").arg(manager->selectedBrick),1);
             }
             void stardundeeSPW_USB::linkNumberSelectionChanged(int linkIndex)
             {
                 this->manager->linkNumber = linkIndex + 1;
                 SocExplorerEngine::message(plugin,QString("Changing Link Number: %1").arg(manager->linkNumber),1);
             }
             void stardundeeSPW_USB::linkSpeedSelectionChanged(const QString &linkSpeed)
             {
                 this->manager->linkSpeed = linkSpeed.toInt();
                 SocExplorerEngine::message(plugin,QString("Changing Link Speed: %1").arg(manager->linkSpeed),1);
             }
             void stardundeeSPW_USB::sourceLogicalAddressChanged(const QString &sourceAddress)
             {
                 this->manager->sourceLogicalAddress = sourceAddress.toInt();
                 SocExplorerEngine::message(plugin,QString("Changing Destination Key: %1").arg(manager->sourceLogicalAddress),1);
             }
             void stardundeeSPW_USB::destinationAddressChanged(const QString &rmapaddress)
             {
                 this->manager->destinationLogicalAddress = rmapaddress.toInt();
                 SocExplorerEngine::message(plugin,QString("Changing RMAP address: %1").arg(manager->destinationLogicalAddress),1);
             }
             void stardundeeSPW_USB::destinationKeyChanged(const QString &key)
             {
                 this->manager->destinationKey = key.toInt();
                 SocExplorerEngine::message(plugin,QString("Changing RMAP Key: %1").arg(manager->destinationKey),1);
             }
             void stardundeeSPW_USB::brickModeChanged( bool interfaceMode )
             {
                 this->manager->interfaceMode = interfaceMode;
             }
             void stardundeeSPW_USB::timecodeFrequencyChanged(const QString &frequency)
             {
                 this->manager->timecodeFrequency = frequency.toDouble();
                 this->manager->setTimecodeFrequency( this->manager->timecodeFrequency);
                 SocExplorerEngine::message(plugin,QString("Changing timecode frequency: %1").arg(manager->timecodeFrequency),1);
             }
             void stardundeeSPW_USB::startSendingTimecodes(bool onOff )
             {
                 this->manager->sendTimecodePeriodically( onOff );
             }
             void stardundeeSPW_USB::rmapTimeoutChanged(const QString &timeout)
             {
                 int tim=timeout.toInt();
                 if(tim<50)
                 {
                     tim = 50;
                     ((StarDundeeGUI*)this->p_GUI)->setRmapTimeout(QString("%1").arg(tim));
                 }
                 this->manager->RMAPtimeout = tim;
                 SocExplorerEngine::message(plugin,QString("Changing RMAP Timeout: %1").arg(manager->RMAPtimeout),1);
             }
             void stardundeeSPW_USB::makeGUI(socexplorerplugin *parent)
             {
                 Q_UNUSED(parent)
                 this->p_GUI = new StarDundeeGUI();
                 //    this->mainLayout = new QGridLayout(this->p_GUI);
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(connectClicked()),this,SLOT(toggleBridgeConnection()));
                 connect(this->manager,SIGNAL(updateAvailableBrickCount(int)),((StarDundeeGUI*)this->p_GUI),SLOT(updateAvailableBrickCount(int)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(brickSelectionChanged(int)),this,SLOT(brickSelectionChanged(int)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(linkNumberSelectionChanged(int)),this,SLOT(linkNumberSelectionChanged(int)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(linkSpeedSelectionChanged(QString)),this,SLOT(linkSpeedSelectionChanged(QString)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(sourceLogicalAddressChanged(QString)),this,SLOT(sourceLogicalAddressChanged(QString)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(rmapAddressChanged(QString)),this,SLOT(destinationAddressChanged(QString)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(destinationKeyChanged(QString)),this,SLOT(destinationKeyChanged(QString)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(rmapTimeoutChanged(QString)),this,SLOT(rmapTimeoutChanged(QString)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(brickModeChanged(bool)), this, SLOT(brickModeChanged(bool)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(timecodeFrequencyChange(QString)), this, SLOT(timecodeFrequencyChanged(QString)));
                 connect(((StarDundeeGUI*)this->p_GUI),SIGNAL(startSendingTimecode(bool)), this, SLOT(startSendingTimecodes(bool)));
                 this->brickSelectionChanged(      ((StarDundeeGUI*)this->p_GUI)->getBrickSelection());
                 this->linkNumberSelectionChanged( ((StarDundeeGUI*)this->p_GUI)->getLinkNumberSelection());
                 this->linkSpeedSelectionChanged(  ((StarDundeeGUI*)this->p_GUI)->getLinkSpeedSelection());
                 this->sourceLogicalAddressChanged(((StarDundeeGUI*)this->p_GUI)->getSourceAddress());
                 this->destinationAddressChanged(  ((StarDundeeGUI*)this->p_GUI)->getDestinationAddress());
                 this->destinationKeyChanged(      ((StarDundeeGUI*)this->p_GUI)->getDestinationKey());
                 this->rmapTimeoutChanged(         ((StarDundeeGUI*)this->p_GUI)->getRmapTimeout());
                 this->brickModeChanged(           ((StarDundeeGUI*)this->p_GUI)->isBrickSetAsAnInterface());
                 connect(this,SIGNAL(SelectBrick(int)),              ((StarDundeeGUI*)this->p_GUI),SLOT(selectBrick(int)));
                 connect(this,SIGNAL(SelectLinkNumber(int)),         ((StarDundeeGUI*)this->p_GUI),SLOT(selectLinkNumber(int)));
                 connect(this,SIGNAL(SelectLinkSpeed(int)),          ((StarDundeeGUI*)this->p_GUI),SLOT(selectLinkSpeed(int)));
                 connect(this,SIGNAL(SetDestinationKey(QString)),    ((StarDundeeGUI*)this->p_GUI),SLOT(setDestinationKey(QString)));
                 connect(this,SIGNAL(SetDestinationAddress(QString)),((StarDundeeGUI*)this->p_GUI),SLOT(setDestinationAddress(QString)));
                 connect(this,SIGNAL(SetSourceAddress(QString)),     ((StarDundeeGUI*)this->p_GUI),SLOT(setSourceAddress(QString)));
                 connect(this,SIGNAL(SetRmapTimeout(QString)),       ((StarDundeeGUI*)this->p_GUI),SLOT(setRmapTimeout(QString)));
                 connect(this,SIGNAL(GetAvailableBrickCount()),      ((StarDundeeGUI*)this->p_GUI),SLOT(getAvailableBrickCount()));
                 connect(this,SIGNAL(GetNbPacketsTransmittedToSpw()),((StarDundeeGUI*)this->p_GUI),SLOT(getNbPacketsTransmittedToSpw()));
                 connect(this,SIGNAL(GetNbCCSDSPacketsTransmittedToSpw()),
                         ((StarDundeeGUI*)this->p_GUI),SLOT(getNbCCSDSPacketsTransmittedToSpw()));
                 connect(this,SIGNAL(SetBrickAsAnInterface(bool)),   ((StarDundeeGUI*)this->p_GUI),SLOT(setBrickAsAnInterface(bool)));
                 connect(this,SIGNAL(SetBrickAsARouter(bool)),       ((StarDundeeGUI*)this->p_GUI),SLOT(setBrickAsARouter(bool)));
                 connect(this,SIGNAL(BytesReceivedFromSpw(uint)),    ((StarDundeeGUI*)this->p_GUI),SLOT(updateNbReceivedBytesFromSpw(uint)));
                 connect(this,SIGNAL(BytesTransmittedToSpw(uint)),   ((StarDundeeGUI*)this->p_GUI),SLOT(updateNbTransmittedBytesToSpw(uint)));
                 connect(this,SIGNAL(CCSDSPacketTransmittedToSpw()), ((StarDundeeGUI*)this->p_GUI),SLOT(updateCCSDSPacketTransmittedToSpw()));
                 connect(this,SIGNAL(SetTimecodeFrequency(double)),  ((StarDundeeGUI*)this->p_GUI),SLOT(setTimecodeFrequency(double)));
                 connect(this,SIGNAL(StartSendingTimecodes(bool)),   ((StarDundeeGUI*)this->p_GUI),SLOT(setStartSendingTimecodes(bool)));
                 connect(this,SIGNAL(SendOneTimecode(unsigned char)),this->manager, SLOT(sendOneTimecode(unsigned char)));
                 connect(this,SIGNAL(GetLinkNumber()),               this->manager, SLOT(getLinkNumber()));
             }
             void stardundeeSPW_USB::sendPacketComingFromTCPServer(char *packet, int size)
             {
                 char* data;
                 int i;
                 data = (char *) malloc( size + 5 );
                 data[0] = this->manager->linkNumber;
                 data[1] = this->manager->destinationLogicalAddress; // target logical address
                 data[2] = SPW_PROTO_ID_CCSDS;                       // protocol identifier
                 data[3] = 0x00;                                     // reserved
                 data[4] = 0x00;                                     // user application
                 for ( i=0; i<size; i++ )
                 {
                     data[i+5] = packet[i];
                 }
                 this->manager->sendPacket( data, size + 5);
                 free(data);
                 free(packet);
             }
             stardundeeSPW_USB_Manager::stardundeeSPW_USB_Manager(socexplorerplugin *plugin, QObject *parent)
                 :QThread((QObject*)parent)
             {
                 this->RMAPtimeout = 2000;
                 this->handleMutex = new QMutex(QMutex::NonRecursive);
             //    this->handleMutex = new QMutex(QMutex::Recursive);
                 this->RMAP_AnswersSem = new QSemaphore(0);
                 this->RMAP_AnswersMtx=new QMutex(QMutex::Recursive);
                 this->RMAP_pending_transaction_IDsMtx=new QMutex(QMutex::Recursive);
                 this->plugin = plugin;
                 connected = false;
                 // TODO remove this crap!
                 this->initDialog();
             //    this->moveToThread(this);
             }
             stardundeeSPW_USB_Manager::~stardundeeSPW_USB_Manager()
             {
                 this->terminate();
                 while (!this->isFinished()) {
                     this->usleep(1000);
                 }
             }
             void stardundeeSPW_USB_Manager::run()
             {
                 USB_SPACEWIRE_PACKET_PROPERTIES properties;
                 USB_SPACEWIRE_ID pIdentifier=NULL;
                 USB_SPACEWIRE_STATUS stat;
                 SocExplorerEngine::message(this->plugin,"Starting Startdundee USB pooling thread",1);
                 char buffer[(RMAP_MAX_XFER_SIZE*4)+50];
                 while (!this->isInterruptionRequested())
                 {
                     if(this->connected)
                     {
                         this->handleMutex->lock();
                         SocExplorerEngine::message(this->plugin,"Looking for new RMAP packets",4);
                         if(USBSpaceWire_WaitOnReadPacketAvailable(hDevice,0.01))
                         {
                             SocExplorerEngine::message(this->plugin,"Got packet",2);
                             stat = USBSpaceWire_ReadPackets(hDevice, buffer, (RMAP_MAX_XFER_SIZE*4)+50,1, 1, &properties, &pIdentifier);
                             if (stat == TRANSFER_SUCCESS)
                             {
                                 if(USBSpaceWire_GetReadTrafficType(&properties, 0) ==SPACEWIRE_TRAFFIC_PACKET)
                                 {
                                     SocExplorerEngine::message(this->plugin,"It's a SPW packet",2);
                                     if(USBSpaceWire_GetReadEOPStatus(&properties, 0)== SPACEWIRE_USB_EOP)
                                     {
                                         SocExplorerEngine::message(this->plugin,"Got end of packet",2);
                                         emit bytesReceivedFromSpw( properties.len );
                                         if(buffer[1]==(char)SPW_PROTO_ID_RMAP) //RMAP packet
                                         {
                                             RMAP_Answer* packet;
                                             SocExplorerEngine::message(this->plugin,"Got RMAP packet",2);
                                             SocExplorerEngine::message(this->plugin,QString("Rmap packet size %1").arg(properties.len),2);
                                             char* packetbuffer = (char*)malloc(properties.len);
                                             memcpy(packetbuffer,buffer,properties.len);
                                             USBSpaceWire_FreeRead(hDevice, pIdentifier);
                                             pIdentifier = NULL;
                                             this->handleMutex->unlock();
                                             if(properties.len==8)
                                             {
                                                 packet=new RMAP_Answer(RMAP_get_transactionID(buffer),packetbuffer,properties.len);
                                             }
                                             else
                                             {
                                                 packet=new RMAP_Answer(RMAP_get_transactionID(buffer+1),packetbuffer,properties.len);
                                             }
                                             RMAP_AnswersMtx->lock();
                                             RMAP_Answers.append(packet);
                                             RMAP_AnswersMtx->unlock();
                                             RMAP_AnswersSem->release();
                                         }
                                         else //any non-rmap packet will be pushed to the network
                                         {
                                             char* packetbuffer = (char*)malloc(properties.len);
                                             memcpy(packetbuffer,buffer,properties.len);
                                             emit emitPacket(packetbuffer,properties.len);
                                             USBSpaceWire_FreeRead(hDevice, pIdentifier);
                                             this->handleMutex->unlock();
                                             SocExplorerEngine::message(this->plugin,"Got SPW packet",2);
                                         }
                                     }
                                     else
                                     {
                                         SocExplorerEngine::message(this->plugin,"No EOP received",2);
                                         this->handleMutex->unlock();
                                     }
                                 }
                             }
                             else
                             {
                                 USBSpaceWire_FreeRead(hDevice, pIdentifier);
                                 this->handleMutex->unlock();
                             }
                         }
                         else
                         {
                             USBSpaceWire_FreeRead(hDevice, pIdentifier);
                             this->handleMutex->unlock();
                         }
                     }
                     else
                     {
                         //do some sanity checks!
                         int list = USBSpaceWire_ListDevices();
                         if(this->brickList!=list)
                         {
                             this->brickList = list;
                             emit updateAvailableBrickCount(this->brickList);
                         }
                         usleep(RMAPtimeout/2);
                     }
                     usleep(1000);
                 }
                 SocExplorerEngine::message(this->plugin,"Exiting Startdundee USB pooling thread",1);
             }
             bool stardundeeSPW_USB_Manager::connectBridge()
             {
                 bool ret;
                 if (this->interfaceMode == BRICK_IS_SET_AS_AN_INTERFACE)
                 {
                     ret = connectBridgeAsInterface();
                 }
                 else if (this->interfaceMode == BRICK_IS_SET_AS_A_ROUTER)
                 {
                     ret = connectBridgeAsRouter();
                 }
                 else
                 {
                     ret = false;
                 }
                 return ret;
             }
             bool stardundeeSPW_USB_Manager::connectBridgeAsInterface()
             {
                 this->handleMutex->lock();
                 int status;
                 U32 statusControl;
                 this->connected = false;
                 if (!USBSpaceWire_Open(&hDevice, this->selectedBrick)) // Open the USB device
                 {
                     SocExplorerEngine::message(this->plugin,"stardundee *** Open *** ERROR: USBSpaceWire_Open(&hDevice, 0))",0);
                     this->handleMutex->unlock();
                     return false;
                 }
                 SocExplorerEngine::message(this->plugin,"stardundee *** Open *** USBSpaceWire_Open successful",0);
                 USBSpaceWire_EnableNetworkMode(hDevice, 0); // deactivate the network mode
                 CFGSpaceWire_EnableRMAP(1);                 // Enable the use of RMAP for the StarDundee brick configuration
                 CFGSpaceWire_SetRMAPDestinationKey(0x20);   // Set the destination key expected by STAR-Dundee devices
                 // Set the path and return path to the device
                 CFGSpaceWire_StackClear();
                 CFGSpaceWire_AddrStackPush(0);
                 CFGSpaceWire_AddrStackPush(254);
                 CFGSpaceWire_RetAddrStackPush(254);
                 // set the base transmit rate to 100 MHz
                 status = CFGSpaceWire_SetBrickBaseTransmitRate( hDevice, CFG_BRK_CLK_100_MHZ, CFG_BRK_DVDR_1, 0xff);
                 if (status != CFG_TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"ERROR CFGSpaceWire_SetBrickBaseTransmitRate",1);
                     this->handleMutex->unlock();
                     return false;
                 }
                 else
                 {
                     SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_SetBrickBaseTransmitRate, base rate = 100 MHz",1);
                 }
                 // read the link status
                 if (CFGSpaceWire_GetLinkStatusControl(hDevice, this->linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(this->linkNumber),1);
                     this->handleMutex->unlock();
                     return false;
                 }
                 else
                 {
                     SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(this->linkNumber),1);
                     // Set the link status control register properties
                     CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);
                     CFGSpaceWire_LSEnableStart(&statusControl, 1);
                     CFGSpaceWire_LSEnableDisabled(&statusControl, 0);
                     CFGSpaceWire_LSEnableTristate(&statusControl, 0);
                     CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9);    // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz
                     // Set the link status control register
                     if (CFGSpaceWire_SetLinkStatusControl(hDevice, this->linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)
                     {
                         SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(this->linkNumber),1);
                         this->handleMutex->unlock();
                         return false;
                     }
                     else
                     {
                         SocExplorerEngine::message(this->plugin,"Set the link status control for link " + QString::number(this->linkNumber),1);
                     }
                 }
                 if (CFGSpaceWire_SetAsInterface(hDevice, 1, 0) != CFG_TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"Could not set the device to be an interface",1);
                     this->handleMutex->unlock();
                     return false;
                 }
                 else
                 {
                     SocExplorerEngine::message(this->plugin,"Device set to be an interface",1);
                 }
                 USBSpaceWire_RegisterReceiveOnAllPorts(hDevice);    // Register to receive on all ports
                 USBSpaceWire_ClearEndpoints(hDevice);               // clear the USB endpoints
                 USBSpaceWire_SetTimeout(hDevice,1.0);
                 this->handleMutex->unlock();
                 SocExplorerEngine::message(this->plugin,"The driver's current send buffer size is " + QString::number(USBSpaceWire_GetDriverSendBufferSize(hDevice)) + " bytes",1);
                 SocExplorerEngine::message(this->plugin,"The driver's current read buffer size is " + QString::number(USBSpaceWire_GetDriverReadBufferSize(hDevice)) + " bytes",1);
                 SocExplorerEngine::message(this->plugin,"USBSpaceWire_IsReadThrottling is " + QString::number(USBSpaceWire_IsReadThrottling(hDevice)),1);
                 this->connected = true;
                 return true;
             }
             bool stardundeeSPW_USB_Manager::connectBridgeAsRouter()
             {
             //    QMutexLocker mlock(&this->handleMutex);
                 this->handleMutex->lock();
                 int status;
                 U32 statusControl;
                 unsigned int linkStatus1;
                 unsigned int linkStatus2;
                 unsigned char linkNumber;
                 unsigned char deviceIsAnInterface;
                 if (!USBSpaceWire_Open(&hDevice, this->selectedBrick)) // Open the USB device
                 {
                     SocExplorerEngine::message(this->plugin,"stardundee *** Open *** ERROR: USBSpaceWire_Open(&hDevice, 0))");
                     this->handleMutex->unlock();
                     return false;
                 }
                 SocExplorerEngine::message(this->plugin,"stardundee *** Open *** USBSpaceWire_Open successful, device number: "
                                  + QString::number(this->selectedBrick));
                 USBSpaceWire_EnableNetworkMode(hDevice, 0); // deactivate the network mode
                 CFGSpaceWire_EnableRMAP(1);                 // Enable the use of RMAP for the StarDundee brick configuration
                 CFGSpaceWire_SetRMAPDestinationKey(0x20);   // Set the destination key expected by STAR-Dundee devices
                 // Set the path and return path to the device
                 // This affects just the operations performed by the Configuration Library and does not affect the packets
                 // sent and received using the driver API.
                 CFGSpaceWire_StackClear();
                 CFGSpaceWire_AddrStackPush(0);
                 CFGSpaceWire_AddrStackPush(254);
                 CFGSpaceWire_RetAddrStackPush(254);
                 // set the base transmit rate to 100 MHz
                 status = CFGSpaceWire_SetBrickBaseTransmitRate( hDevice, CFG_BRK_CLK_100_MHZ, CFG_BRK_DVDR_1, 0xff);
                 if (status != CFG_TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"ERROR CFGSpaceWire_SetBrickBaseTransmitRate");
                 }
                 else SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_SetBrickBaseTransmitRate, base rate = 100 MHz");
                 //*********************
                 // LINK 1 CONFIGURATION
                 linkNumber = 1;
                 if (CFGSpaceWire_GetLinkStatusControl(hDevice, linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)
                     SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(linkNumber));
                 else
                 {
                     SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(linkNumber));
                     // Set the link status control register properties
                     CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);
                     CFGSpaceWire_LSEnableStart(&statusControl, 1);
                     CFGSpaceWire_LSEnableDisabled(&statusControl, 0);
                     CFGSpaceWire_LSEnableTristate(&statusControl, 0);
                     CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9);    // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz
                     // Set the link status control register
                     if (CFGSpaceWire_SetLinkStatusControl(hDevice, linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)
                         SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(linkNumber));
                     else
                         SocExplorerEngine::message(this->plugin,"link status control for link " + QString::number(0x01) + " is set");
                 }
                 //*********************
                 // LINK 2 CONFIGURATION
                 linkNumber = 2;
                 if (CFGSpaceWire_GetLinkStatusControl(hDevice, linkNumber, &statusControl) != CFG_TRANSFER_SUCCESS)
                     SocExplorerEngine::message(this->plugin,"Could not read link status control for link " + QString::number(linkNumber));
                 else
                 {
                     SocExplorerEngine::message(this->plugin,"OK CFGSpaceWire_GetLinkStatusControl of link " + QString::number(linkNumber));
                     // Set the link status control register properties
                     CFGSpaceWire_LSEnableAutoStart(&statusControl, 1);
                     CFGSpaceWire_LSEnableStart(&statusControl, 1);
                     CFGSpaceWire_LSEnableDisabled(&statusControl, 0);
                     CFGSpaceWire_LSEnableTristate(&statusControl, 0);
                     CFGSpaceWire_LSSetOperatingSpeed(&statusControl, 9);    // sets the link speed to ( 100 MHz / (9+1) ) = 10 MHz
                     // Set the link status control register
                     if (CFGSpaceWire_SetLinkStatusControl(hDevice, linkNumber, statusControl) != CFG_TRANSFER_SUCCESS)
                         SocExplorerEngine::message(this->plugin,"Could not set the link status control for link " + QString::number(linkNumber));
                     else
                         SocExplorerEngine::message(this->plugin,"link status control for link " + QString::number(linkNumber) + " is set");
                 }
                 //***************************
                 // SET THE DEVICE AS A ROUTER
                 deviceIsAnInterface = 0;    // 0 = router, 1 = interface
                 if (CFGSpaceWire_SetAsInterface(hDevice, deviceIsAnInterface, 0) != CFG_TRANSFER_SUCCESS)
                     SocExplorerEngine::message(this->plugin,"Could not set the device to be an interface");
                 else
                     SocExplorerEngine::message(this->plugin,"Device is an interface: " + QString::number(deviceIsAnInterface) + " (1 => true, 0 => false)");
                 setRoutingTableEntry(0xfe, 0x02, 0); // [0010] => route 0xfe on port 1
                 setRoutingTableEntry(32  , 0x08, 0); // [1000] => route 32   on port 3
                 USBSpaceWire_RegisterReceiveOnAllPorts(hDevice);  // Register to receive on port 1 only
                 USBSpaceWire_ClearEndpoints(hDevice);               // clear the USB endpoints
                 SocExplorerEngine::message(this->plugin,"The driver's current send buffer size is " + QString::number(USBSpaceWire_GetDriverSendBufferSize(hDevice)) + " bytes");
                 SocExplorerEngine::message(this->plugin,"The driver's current read buffer size is " + QString::number(USBSpaceWire_GetDriverReadBufferSize(hDevice)) + " bytes");
                 SocExplorerEngine::message(this->plugin,"USBSpaceWire_IsReadThrottling is " + QString::number(USBSpaceWire_IsReadThrottling(hDevice)));
                 //************
                 // test Link 1 and Link 2
                 linkStatus1 = getLinkStatus(0x01);
                 linkStatus2 = getLinkStatus(0x02);
                 this->handleMutex->unlock();
                 if ((linkStatus1==1) || (linkStatus2==1))
                 {
                     initializeTimecodeGeneration();
                     this->connected=true;
                     return true;
                 }
                 else
                 {
                     statusLink1->setText("Link 1 status code: " + QString::number(linkStatus1));
                     statusLink2->setText("Link 2 status code: " + QString::number(linkStatus2));
                     starDundeeStatusQueryDialog->exec();
                     this->connected = false;
                     return false;
                 }
             }
             void stardundeeSPW_USB_Manager::initDialog( void )
             {
                 // STAR DUNDEE STATUS QUERY DIALOG
                 starDundeeStatusQueryDialog         = new QDialog;
                 starDundeeStatusQueryDialogLayout   = new QGridLayout;
                 starDundeeStatusQueryDialogLabel    = new QLabel(tr("SpaceWire links state"));
                 starDundeeStatusQueryContinueButton = new QPushButton(tr("Continue"));
                 starDundeeStatusQueryRetryButton    = new QPushButton(tr("Retry"));
                 starDundeeStatusQueryAbortButton    = new QPushButton(tr("Abort"));
                 statusLink1 = new QLabel(tr("Link 1 status code: -"));
                 statusLink2 = new QLabel(tr("Link 2 status code: -"));
                 starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryDialogLabel, 0, 0, 1, 2);
                 starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryContinueButton, 1, 0, 0);
                 starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryRetryButton, 1, 1, 0);
                 starDundeeStatusQueryDialogLayout->addWidget(starDundeeStatusQueryAbortButton, 1, 2, 0);
                 starDundeeStatusQueryDialogLayout->addWidget(statusLink1, 2, 0, 0);
                 starDundeeStatusQueryDialogLayout->addWidget(statusLink2, 3, 0, 0);
                 starDundeeStatusQueryDialog->setLayout(starDundeeStatusQueryDialogLayout);
             }
             unsigned char stardundeeSPW_USB_Manager::setRoutingTableEntry(int tableEntry, U32 dwOutputPorts, char bDelHead)
             {
                 U32 routingTableEntry;
                 // SET THE ROUTING TABLE ENTRY FOR LOGICAL ADDRESSING, TARGET entryNumber
                 if (CFGSpaceWire_ClearRoutingTableEntry(hDevice, tableEntry) != CFG_TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"Could not clear routing table entry " + QString::number(tableEntry));
                 }
                 // Build the routing table entry
                 CFGSpaceWire_RTBuildRoutingTableEntry(&routingTableEntry,
                                                       dwOutputPorts,        // route out of port dwOutputPorts
                                                       bDelHead,             // header deletion is enabled [1] or disabled [0]
 );                   // priority normal
                 // Set the routing table entry for logical address tableEntry
                 if (CFGSpaceWire_SetRoutingTableEntry(hDevice, tableEntry, routingTableEntry) != CFG_TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"Could not set routing table entry [" + QString::number(tableEntry) + "]");
                 }
                 else SocExplorerEngine::message(this->plugin,"Routing table entry [" + QString::number(tableEntry) + "] set" );
                 return 1;
             }
             unsigned int stardundeeSPW_USB_Manager::getRoutingTableEntry(int tableEntry)
             {
                 U32 routingTableEntry, outputPorts;
                 char enabled, delHead, priority;
                 int portNum;
                 SocExplorerEngine::message(this->plugin,"GetRoutingTableEntry [" + QString::number(tableEntry) + "]");
                 // Read the routing table entry
                 if (CFGSpaceWire_GetRoutingTableEntry(hDevice, tableEntry, &routingTableEntry) != CFG_TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"Could not read routing table entry [" + QString::number(tableEntry) + "]");
                 }
                 else
                 {
                     // Display the routing table entry properties
                     CFGSpaceWire_RTIsEnabled(routingTableEntry, &enabled);
                     CFGSpaceWire_RTIsDelHead(routingTableEntry, &delHead);
                     CFGSpaceWire_RTIsPriority(routingTableEntry, &priority);
                     CFGSpaceWire_RTGetOutputPorts(routingTableEntry, &outputPorts);
                     SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsEnabled      : " + QString::number(enabled));
                     SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsDelHead      : " + QString::number(delHead));
                     SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTIsPriority     : " + QString::number(priority));
                     SocExplorerEngine::message(this->plugin,"CFGSpaceWire_RTGetOutputPorts : ");
                     for (portNum = 0; portNum < 32; portNum++)
                     {
                         if (outputPorts & (1 << portNum))
                         {
                             SocExplorerEngine::message(this->plugin,QString::number(portNum));
                         }
                     }
                 }
                 return 1;
             }
             void stardundeeSPW_USB_Manager::initializeTimecodeGeneration()
             {
                 U32 dwTickEnableStatus;
                 U32 rtr_clk_freq;
                 // (1) RESET
                 if (!USBSpaceWire_TC_Reset(hDevice))
                     SocExplorerEngine::message(this->plugin,"ERR *** in Open *** Could not reset timecodes\n");
                 // (2) Clear the tick enable register
                 if (CFGSpaceWire_SetTickEnableStatus(hDevice, 6) != CFG_TRANSFER_SUCCESS)
                     SocExplorerEngine::message(this->plugin,"Could not clear the tick enable register");
                 else
                     SocExplorerEngine::message(this->plugin,"Cleared the tick enable register");
                 // (3) get the tick status
                 CFGSpaceWire_GetTickEnableStatus(hDevice, &dwTickEnableStatus);
                 SocExplorerEngine::message(this->plugin,"OK *** in Open *** CFGSpaceWire_GetTickEnableStatus, code is " + QString::number(dwTickEnableStatus, 2));
                 // (4) enable external timecode selection
                 if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,0))
                     SocExplorerEngine::message(this->plugin,"ERR *** disable external timecode selection");
                 rtr_clk_freq = USBSpaceWire_TC_GetClockFrequency(hDevice);
                 SocExplorerEngine::message(this->plugin,"clock frequency = " + QString::number(rtr_clk_freq) );
                 //**************************************************
                 // auto _ tick _ freq = rtr _ clk _ freq / freqCount
                 if (!USBSpaceWire_TC_SetAutoTickInFrequency(hDevice, rtr_clk_freq) )
                     SocExplorerEngine::message(this->plugin,"Could not set the tick-in frequency");
             }
             unsigned int stardundeeSPW_USB_Manager::getLinkStatus(unsigned char link)
             {
                 U32 statusControl, errorStatus, portType;
                 U32 linkStatus, operatingSpeed, outputPortConnection;
                 char isLinkRunning, isAutoStart, isStart, isDisabled, isTristate;
                 // Read the link status control register
                 if (CFGSpaceWire_GetLinkStatusControl(hDevice, link, &statusControl) != CFG_TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"Could not read link status control for link" + QString::number(link));
                 }
                 else
                 {
                     // Display the link status control register properties
                     CFGSpaceWire_LSPortType(statusControl, &portType);
                     if (portType == CFG_CONFIGURATION_PORT)
                     {
                         CFGSpaceWire_LSConfigErrorStatus(statusControl, &errorStatus);
                     }
                     else if (portType == CFG_SPACEWIRE_EXTERNAL_PORT)
                     {
                         CFGSpaceWire_LSExternalErrorStatus(statusControl, &errorStatus);
                     }
                     else
                     {
                         CFGSpaceWire_LSErrorStatus(statusControl, &errorStatus);
                     }
                     CFGSpaceWire_LSLinkState(statusControl, &linkStatus);
                     CFGSpaceWire_LSIsLinkRunning(statusControl, &isLinkRunning);
                     CFGSpaceWire_LSIsAutoStart(statusControl, &isAutoStart);
                     CFGSpaceWire_LSIsStart(statusControl, &isStart);
                     CFGSpaceWire_LSIsDisabled(statusControl, &isDisabled);
                     CFGSpaceWire_LSIsTristate(statusControl, &isTristate);
                     CFGSpaceWire_LSOperatingSpeed(statusControl, &operatingSpeed);
                     CFGSpaceWire_LSOutputPortConnection(statusControl, &outputPortConnection);
                 }
                 SocExplorerEngine::message(this->plugin,"status of link " + QString::number(link)
                                            +" is " + dwLinkStatusQString[linkStatus]);
                 if (linkStatus == 5)
                 {
                     return 1;
                 }
                 else return 0;
             }
             bool stardundeeSPW_USB_Manager::disconnectBridge()
             {
                 this->handleMutex->lock();
                 USBSpaceWire_Close(hDevice); // Close the device
                 SocExplorerEngine::message(this->plugin,"stardundee *** Close *** USBSpaceWire_Close, device: " + QString::number(0),0);
                 USBSpaceWire_UnregisterReceiveOnAllPorts(hDevice);  // Stop receiving on all ports
                 this->handleMutex->unlock();
                 this->RMAP_pending_transaction_IDsMtx->lock();
                 this->RMAP_pending_transaction_IDs.clear();
                 this->RMAP_pending_transaction_IDsMtx->unlock();
                 this->RMAP_AnswersMtx->lock();
                 this->RMAP_Answers.clear();
                 this->RMAP_AnswersMtx->unlock();
                 this->RMAP_AnswersSem->acquire(this->RMAP_AnswersSem->available());
                 return true;
             }
             int stardundeeSPW_USB_Manager::getRMAPtransactionID()
             {
                 this->RMAP_pending_transaction_IDsMtx->lock();
                 int  ID=0;
                 bool found=true;
                 while(ID<511)
                 {
                     for(int i=0;i<RMAP_pending_transaction_IDs.count();i++)
                     {
                         if(RMAP_pending_transaction_IDs[i]==ID)found=false;
                     }
                     if(found==true)break;
                     ID++;
                     found = true;
                 }
                 if(found)
                 {
                     RMAP_pending_transaction_IDs.append(ID);
                 }
                 this->RMAP_pending_transaction_IDsMtx->unlock();
                 return ID;
             }
             int stardundeeSPW_USB_Manager::getRMAPanswer(int transactionID, char **buffer)
             {
                 QTime timeout;
                 *buffer=NULL;
                 int count=0;
                 SocExplorerEngine::message(this->plugin,"Looking for RMAP answer",2);
                 timeout.start();
                 while (*buffer==NULL)
                 {
                     this->RMAP_AnswersMtx->lock();
                     SocExplorerEngine::message(this->plugin,"Got exclusive access on RMAP_Answers stack",2);
                     SocExplorerEngine::message(this->plugin,QString("%1 packet(s) available in RMAP_Answers stack").arg(RMAP_Answers.count()),2);
                     for(int i=0;i<RMAP_Answers.count();i++)
                     {
                         SocExplorerEngine::message(this->plugin,QString("Packet %1 ID=%2").arg(i).arg(RMAP_Answers[i]->transactionID),2);
                         if(RMAP_Answers[i]->transactionID==transactionID)
                         {
                             this->RMAP_pending_transaction_IDsMtx->lock();
                             SocExplorerEngine::message(this->plugin,"Got exclusive access on RMAP_pending_transaction_ID stack",2);
                             for(int j=0;j<RMAP_pending_transaction_IDs.count();j++)
                             {
                                 if(RMAP_pending_transaction_IDs[j]==transactionID)
                                 {
                                     RMAP_pending_transaction_IDs.removeAt(j);
                                 }
                             }
                             this->RMAP_pending_transaction_IDsMtx->unlock();
                             *buffer = RMAP_Answers[i]->data;
                             count = RMAP_Answers[i]->len;
                             RMAP_Answer* tmp=RMAP_Answers[i];
                             RMAP_Answers.removeAt(i);
                             delete tmp;
                         }
                     }
                     this->RMAP_AnswersMtx->unlock();
                     //if no answer found in the stack wait until a new packet is pushed
                     SocExplorerEngine::message(this->plugin,"waiting until a new packet is pushed",2);
                     if(*buffer==NULL)
                     {
                         while (0==this->RMAP_AnswersSem->available())
                         {
                             SocExplorerEngine::message(this->plugin,QString("this->RMAP_AnswersSem->available() = %1").arg(this->RMAP_AnswersSem->available()),2);
                             if(timeout.elapsed()>=RMAPtimeout)
                             {
                                 SocExplorerEngine::message(this->plugin,"Timeout reached giving up!",2);
                                 return -1;
                             }
                             usleep(1000);
                         }
                         this->RMAP_AnswersSem->acquire();
                     }
                 }
                 return count;
             }
             bool stardundeeSPW_USB_Manager::sendPacket(char *packet, int size)
             {
                 char protocoleIdentifier;
                 USB_SPACEWIRE_STATUS result=TRANSFER_ERROR_NOT_FOUND;
                 USB_SPACEWIRE_ID pIdentifier;
                 SocExplorerEngine::message(this->plugin,"Sending SPW packet",2);
                 this->handleMutex->lock();
                 result = USBSpaceWire_SendPacket(hDevice,packet,size,1, &pIdentifier);
                 USBSpaceWire_FreeSend(hDevice, pIdentifier);
                 this->handleMutex->unlock();
                 if (result != TRANSFER_SUCCESS)
                 {
                     SocExplorerEngine::message(this->plugin,"ERR sending the READ command ",2);
                     return false;
                 }
                 else
                 {
                     emit bytesTransmittedToSpw( size-1 ); // -1 is for removing the first bytes added to the packet to route to the right link
                     // read the protocole identifier
                     protocoleIdentifier = packet[2];
                     if (protocoleIdentifier == SPW_PROTO_ID_CCSDS)
                             emit ccsdsPacketTransmittedToSpw();
                     SocExplorerEngine::message(this->plugin,"Packet sent",2);
                 }
-            //    this->handleMutex->unlock();
                 return true;
             }
             void stardundeeSPW_USB_Manager::pushRmapPacket(char *packet, int len)
             {
                 char* packetbuffer = (char*)malloc(len);
                 memcpy(packetbuffer,packet,len);
                 RMAP_Answer* RMPAPpacket=new RMAP_Answer(RMAP_get_transactionID(packetbuffer+1),packetbuffer,len);
                 RMAP_AnswersMtx->lock();
                 RMAP_Answers.append(RMPAPpacket);
                 RMAP_AnswersMtx->unlock();
             }
             void stardundeeSPW_USB_Manager::sendTimecodePeriodically( bool onOff )
             {
+                this->handleMutex->lock();
                 if (onOff == true)
                 {
                     if (!USBSpaceWire_TC_EnableAutoTickIn(hDevice, 1, 1))
                         SocExplorerEngine::message(this->plugin,"Could not enable auto tick-in");
                 }
                 else
                 {
                     if (!USBSpaceWire_TC_EnableAutoTickIn(hDevice, 0, 0))
                         SocExplorerEngine::message(this->plugin,"Could not disable auto tick-in");
                 }
+                this->handleMutex->unlock();
             }
             int stardundeeSPW_USB_Manager::getLinkNumber( void )
             {
                 return this->linkNumber;
             }
             void stardundeeSPW_USB_Manager::setTimecodeFrequency(double requestedFrequency)
             {
                 U32 rtr_clk_freq=0;
                 U32 freqCount=0;
                 double freqCountInDouble=0.0;
                 double currentFrequency=0.0;
+                this->handleMutex->lock();
                 rtr_clk_freq = USBSpaceWire_TC_GetClockFrequency(hDevice);
                 freqCountInDouble = ((double) rtr_clk_freq) / requestedFrequency;
                 freqCount = (unsigned int) freqCountInDouble;
                 currentFrequency = ((double) rtr_clk_freq) / ((double) freqCount);
                 //**************************************************
                 // auto _ tick _ freq = rtr _ clk _ freq / freqCount
                 if (!USBSpaceWire_TC_SetAutoTickInFrequency(hDevice, freqCount) )
                     SocExplorerEngine::message(this->plugin,"Could not set the tick-in frequency");
                 else
                     SocExplorerEngine::message(this->plugin,"tick frequency set to " + QString::number(currentFrequency) +" Hz"
                                                + " (freqCount set to " + QString::number(freqCount) + ")" );
+                this->handleMutex->unlock();
             }
             void stardundeeSPW_USB_Manager::sendOneTimecode( unsigned char nTimein )
             {
+                this->handleMutex->lock();
                 // enable external timecode selection
                 if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,1))
                     SocExplorerEngine::message(this->plugin,"sendOneTimecode *** ERR *** enable external timecode selection");
                 if (!USBSpaceWire_TC_PerformTickIn( hDevice, nTimein) )
                     SocExplorerEngine::message( this->plugin,"sendOneTimecode *** ERR *** Could not send the requested timecode: " + QString::number(nTimein) );
                 else
                     SocExplorerEngine::message( this->plugin,"sendOneTimecode *** OK *** timecode sent " + QString::number(nTimein) );
                 // disable external timecode selection
                 if(!USBSpaceWire_TC_EnableExternalTimecodeSelection(hDevice,0))
                     SocExplorerEngine::message(this->plugin,"sendOneTimecode *** ERR *** disable external timecode selection");
+                this->handleMutex->unlock();
             }