HG_REPOSITORIES/LPP/INSTRUMENTATION/SOLO_LFR/DEV_PLE Commit - r160:75f8f2eae54e

1

/** Functions and tasks related to waveform packet generation.

1

/** Functions and tasks related to waveform packet generation.

2

*

2

*

3

* @file

3

* @file

4

* @author P. LEROY

4

* @author P. LEROY

5

*

5

*

6

* A group of functions to handle waveforms, in snapshot or continuous format.\n

6

* A group of functions to handle waveforms, in snapshot or continuous format.\n

7

*

7

*

8

*/

8

*/

9

10

#include "wf_handler.h"

10

#include "wf_handler.h"

11

12

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

12

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

13

// waveform headers

13

// waveform headers

14

// SWF

14

// SWF

15

Header_TM_LFR_SCIENCE_SWF_t headerSWF_F0[7];

15

Header_TM_LFR_SCIENCE_SWF_t headerSWF_F0[7];

16

Header_TM_LFR_SCIENCE_SWF_t headerSWF_F1[7];

16

Header_TM_LFR_SCIENCE_SWF_t headerSWF_F1[7];

17

Header_TM_LFR_SCIENCE_SWF_t headerSWF_F2[7];

17

Header_TM_LFR_SCIENCE_SWF_t headerSWF_F2[7];

18

// CWF

18

// CWF

19

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F1[ NB_PACKETS_PER_GROUP_OF_CWF ];

19

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F1[ NB_PACKETS_PER_GROUP_OF_CWF ];

20

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F2_BURST[ NB_PACKETS_PER_GROUP_OF_CWF ];

20

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F2_BURST[ NB_PACKETS_PER_GROUP_OF_CWF ];

21

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F2_SBM2[ NB_PACKETS_PER_GROUP_OF_CWF ];

21

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F2_SBM2[ NB_PACKETS_PER_GROUP_OF_CWF ];

22

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F3[ NB_PACKETS_PER_GROUP_OF_CWF ];

22

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F3[ NB_PACKETS_PER_GROUP_OF_CWF ];

23

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F3_light[ NB_PACKETS_PER_GROUP_OF_CWF_LIGHT ];

23

Header_TM_LFR_SCIENCE_CWF_t headerCWF_F3_light[ NB_PACKETS_PER_GROUP_OF_CWF_LIGHT ];

24

25

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

25

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

26

// waveform ring

26

// waveform ring

27

ring_node waveform_ring_f0[NB_RING_NODES_F0];

27

ring_node waveform_ring_f0[NB_RING_NODES_F0];

28

ring_node waveform_ring_f1[NB_RING_NODES_F1];

28

ring_node waveform_ring_f1[NB_RING_NODES_F1];

29

ring_node waveform_ring_f2[NB_RING_NODES_F2];

29

ring_node waveform_ring_f2[NB_RING_NODES_F2];

30

ring_node waveform_ring_f3[NB_RING_NODES_F3];

30

ring_node waveform_ring_f3[NB_RING_NODES_F3];

31

ring_node *current_ring_node_f0;

31

ring_node *current_ring_node_f0;

32

ring_node *ring_node_to_send_swf_f0;

32

ring_node *ring_node_to_send_swf_f0;

33

ring_node *current_ring_node_f1;

33

ring_node *current_ring_node_f1;

34

ring_node *ring_node_to_send_swf_f1;

34

ring_node *ring_node_to_send_swf_f1;

35

ring_node *ring_node_to_send_cwf_f1;

35

ring_node *ring_node_to_send_cwf_f1;

36

ring_node *current_ring_node_f2;

36

ring_node *current_ring_node_f2;

37

ring_node *ring_node_to_send_swf_f2;

37

ring_node *ring_node_to_send_swf_f2;

38

ring_node *ring_node_to_send_cwf_f2;

38

ring_node *ring_node_to_send_cwf_f2;

39

ring_node *current_ring_node_f3;

39

ring_node *current_ring_node_f3;

40

ring_node *ring_node_to_send_cwf_f3;

40

ring_node *ring_node_to_send_cwf_f3;

41

42

bool extractSWF = false;

42

bool extractSWF = false;

43

bool swf_f0_ready = false;

43

bool swf_f0_ready = false;

44

bool swf_f1_ready = false;

44

bool swf_f1_ready = false;

45

bool swf_f2_ready = false;

45

bool swf_f2_ready = false;

46

47

int wf_snap_extracted[ (NB_SAMPLES_PER_SNAPSHOT * NB_WORDS_SWF_BLK) + TIME_OFFSET ];

47

int wf_snap_extracted[ (NB_SAMPLES_PER_SNAPSHOT * NB_WORDS_SWF_BLK) + TIME_OFFSET ];

48

49

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

49

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

50

// Interrupt SubRoutine

50

// Interrupt SubRoutine

51

52

void reset_extractSWF( void )

52

void reset_extractSWF( void )

53

{

53

{

54

extractSWF = false;

54

extractSWF = false;

55

swf_f0_ready = false;

55

swf_f0_ready = false;

56

swf_f1_ready = false;

56

swf_f1_ready = false;

57

swf_f2_ready = false;

57

swf_f2_ready = false;

58

}

58

}

59

60

rtems_isr waveforms_isr( rtems_vector_number vector )

60

rtems_isr waveforms_isr( rtems_vector_number vector )

61

{

61

{

62

/** This is the interrupt sub routine called by the waveform picker core.

62

/** This is the interrupt sub routine called by the waveform picker core.

63

*

63

*

64

* This ISR launch different actions depending mainly on two pieces of information:

64

* This ISR launch different actions depending mainly on two pieces of information:

65

* 1. the values read in the registers of the waveform picker.

65

* 1. the values read in the registers of the waveform picker.

66

* 2. the current LFR mode.

66

* 2. the current LFR mode.

67

*

67

*

68

*/

68

*/

69

70

rtems_status_code status;

70

rtems_status_code status;

71

72

if ( (lfrCurrentMode == LFR_MODE_NORMAL) || (lfrCurrentMode == LFR_MODE_BURST) // in BURST the data are used to place v, e1 and e2 in the HK packet

72

if ( (lfrCurrentMode == LFR_MODE_NORMAL) || (lfrCurrentMode == LFR_MODE_BURST) // in BURST the data are used to place v, e1 and e2 in the HK packet

73

|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )

73

|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )

74

{ // in modes other than STANDBY and BURST, send the CWF_F3 data

74

{ // in modes other than STANDBY and BURST, send the CWF_F3 data

75

if ((waveform_picker_regs->status & 0x08) == 0x08){ // [1000] f3 is full

75

if ((waveform_picker_regs->status & 0x08) == 0x08){ // [1000] f3 is full

76

// (1) change the receiving buffer for the waveform picker

76

// (1) change the receiving buffer for the waveform picker

77

ring_node_to_send_cwf_f3 = current_ring_node_f3;

77

ring_node_to_send_cwf_f3 = current_ring_node_f3;

78

current_ring_node_f3 = current_ring_node_f3->next;

78

current_ring_node_f3 = current_ring_node_f3->next;

79

waveform_picker_regs->addr_data_f3 = current_ring_node_f3->buffer_address;

79

waveform_picker_regs->addr_data_f3 = current_ring_node_f3->buffer_address;

80

// (2) send an event for the waveforms transmission

80

// (2) send an event for the waveforms transmission

81

if (rtems_event_send( Task_id[TASKID_CWF3], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL) {

81

if (rtems_event_send( Task_id[TASKID_CWF3], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL) {

82

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );

82

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );

83

}

83

}

84

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2);

84

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2);

85

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffff777; // reset f3 bits to 0, [1111 0111 0111 0111]

85

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffff777; // reset f3 bits to 0, [1111 0111 0111 0111]

86

}

86

}

87

}

87

}

88

89

switch(lfrCurrentMode)

89

switch(lfrCurrentMode)

90

{

90

{

91

//********

91

//********

92

// STANDBY

92

// STANDBY

93

case(LFR_MODE_STANDBY):

93

case(LFR_MODE_STANDBY):

94

break;

94

break;

95

96

//******

96

//******

97

// NORMAL

97

// NORMAL

98

case(LFR_MODE_NORMAL):

98

case(LFR_MODE_NORMAL):

99

if ( (waveform_picker_regs->status & 0xff8) != 0x00) // [1000] check the error bits

99

if ( (waveform_picker_regs->status & 0xff8) != 0x00) // [1000] check the error bits

100

{

100

{

101

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );

101

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );

102

}

102

}

103

if ( (waveform_picker_regs->status & 0x07) == 0x07) // [0111] check the f2, f1, f0 full bits

103

if ( (waveform_picker_regs->status & 0x07) == 0x07) // [0111] check the f2, f1, f0 full bits

104

{

104

{

105

// change F0 ring node

105

// change F0 ring node

106

ring_node_to_send_swf_f0 = current_ring_node_f0;

106

ring_node_to_send_swf_f0 = current_ring_node_f0;

107

current_ring_node_f0 = current_ring_node_f0->next;

107

current_ring_node_f0 = current_ring_node_f0->next;

108

waveform_picker_regs->addr_data_f0 = current_ring_node_f0->buffer_address;

108

waveform_picker_regs->addr_data_f0 = current_ring_node_f0->buffer_address;

109

// change F1 ring node

109

// change F1 ring node

110

ring_node_to_send_swf_f1 = current_ring_node_f1;

110

ring_node_to_send_swf_f1 = current_ring_node_f1;

111

current_ring_node_f1 = current_ring_node_f1->next;

111

current_ring_node_f1 = current_ring_node_f1->next;

112

waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address;

112

waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address;

113

// change F2 ring node

113

// change F2 ring node

114

ring_node_to_send_swf_f2 = current_ring_node_f2;

114

ring_node_to_send_swf_f2 = current_ring_node_f2;

115

current_ring_node_f2 = current_ring_node_f2->next;

115

current_ring_node_f2 = current_ring_node_f2->next;

116

waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;

116

waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;

117

//

117

//

118

if (rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_NORMAL ) != RTEMS_SUCCESSFUL)

118

if (rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_NORMAL ) != RTEMS_SUCCESSFUL)

119

{

119

{

120

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );

120

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );

121

}

121

}

122

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffff888; // [1000 1000 1000]

122

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffff888; // [1000 1000 1000]

123

}

123

}

124

break;

124

break;

125

126

//******

126

//******

127

// BURST

127

// BURST

128

case(LFR_MODE_BURST):

128

case(LFR_MODE_BURST):

129

if ( (waveform_picker_regs->status & 0x04) == 0x04 ){ // [0100] check the f2 full bit

129

if ( (waveform_picker_regs->status & 0x04) == 0x04 ){ // [0100] check the f2 full bit

130

// (1) change the receiving buffer for the waveform picker

130

// (1) change the receiving buffer for the waveform picker

131

ring_node_to_send_cwf_f2 = current_ring_node_f2;

131

ring_node_to_send_cwf_f2 = current_ring_node_f2;

132

current_ring_node_f2 = current_ring_node_f2->next;

132

current_ring_node_f2 = current_ring_node_f2->next;

133

waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;

133

waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;

134

// (2) send an event for the waveforms transmission

134

// (2) send an event for the waveforms transmission

135

if (rtems_event_send( Task_id[TASKID_CWF2], RTEMS_EVENT_MODE_BURST ) != RTEMS_SUCCESSFUL) {

135

if (rtems_event_send( Task_id[TASKID_CWF2], RTEMS_EVENT_MODE_BURST ) != RTEMS_SUCCESSFUL) {

136

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );

136

rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );

137

}

137

}

138

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bit = 0

138

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bit = 0

139

}

139

}

140

break;

140

break;

141

142

//*****

142

//*****

143

// SBM1

143

// SBM1

144

case(LFR_MODE_SBM1):

144

case(LFR_MODE_SBM1):

145

if ( (waveform_picker_regs->status & 0x02) == 0x02 ) { // [0010] check the f1 full bit

145

if ( (waveform_picker_regs->status & 0x02) == 0x02 ) { // [0010] check the f1 full bit

146

// (1) change the receiving buffer for the waveform picker

146

// (1) change the receiving buffer for the waveform picker

147

ring_node_to_send_cwf_f1 = current_ring_node_f1;

147

ring_node_to_send_cwf_f1 = current_ring_node_f1;

148

current_ring_node_f1 = current_ring_node_f1->next;

148

current_ring_node_f1 = current_ring_node_f1->next;

149

waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address;

149

waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address;

150

// (2) send an event for the the CWF1 task for transmission (and snapshot extraction if needed)

150

// (2) send an event for the the CWF1 task for transmission (and snapshot extraction if needed)

151

status = rtems_event_send( Task_id[TASKID_CWF1], RTEMS_EVENT_MODE_SBM1 );

151

status = rtems_event_send( Task_id[TASKID_CWF1], RTEMS_EVENT_MODE_SBM1 );

152

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffddd; // [1111 1101 1101 1101] f1 bits = 0

152

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffddd; // [1111 1101 1101 1101] f1 bits = 0

153

}

153

}

154

if ( (waveform_picker_regs->status & 0x01) == 0x01 ) { // [0001] check the f0 full bit

154

if ( (waveform_picker_regs->status & 0x01) == 0x01 ) { // [0001] check the f0 full bit

155

swf_f0_ready = true;

155

swf_f0_ready = true;

156

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffeee; // [1111 1110 1110 1110] f0 bits = 0

156

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffeee; // [1111 1110 1110 1110] f0 bits = 0

157

}

157

}

158

if ( (waveform_picker_regs->status & 0x04) == 0x04 ) { // [0100] check the f2 full bit

158

if ( (waveform_picker_regs->status & 0x04) == 0x04 ) { // [0100] check the f2 full bit

159

swf_f2_ready = true;

159

swf_f2_ready = true;

160

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bits = 0

160

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bits = 0

161

}

161

}

162

break;

162

break;

163

164

//*****

164

//*****

165

// SBM2

165

// SBM2

166

case(LFR_MODE_SBM2):

166

case(LFR_MODE_SBM2):

167

if ( (waveform_picker_regs->status & 0x04) == 0x04 ){ // [0100] check the f2 full bit

167

if ( (waveform_picker_regs->status & 0x04) == 0x04 ){ // [0100] check the f2 full bit

168

// (1) change the receiving buffer for the waveform picker

168

// (1) change the receiving buffer for the waveform picker

169

ring_node_to_send_cwf_f2 = current_ring_node_f2;

169

ring_node_to_send_cwf_f2 = current_ring_node_f2;

170

current_ring_node_f2 = current_ring_node_f2->next;

170

current_ring_node_f2 = current_ring_node_f2->next;

171

waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;

171

waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;

172

// (2) send an event for the waveforms transmission

172

// (2) send an event for the waveforms transmission

173

status = rtems_event_send( Task_id[TASKID_CWF2], RTEMS_EVENT_MODE_SBM2 );

173

status = rtems_event_send( Task_id[TASKID_CWF2], RTEMS_EVENT_MODE_SBM2 );

174

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bit = 0

174

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bit = 0

175

}

175

}

176

if ( (waveform_picker_regs->status & 0x01) == 0x01 ) { // [0001] check the f0 full bit

176

if ( (waveform_picker_regs->status & 0x01) == 0x01 ) { // [0001] check the f0 full bit

177

swf_f0_ready = true;

177

swf_f0_ready = true;

178

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffeee; // [1111 1110 1110 1110] f0 bits = 0

178

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffeee; // [1111 1110 1110 1110] f0 bits = 0

179

}

179

}

180

if ( (waveform_picker_regs->status & 0x02) == 0x02 ) { // [0010] check the f1 full bit

180

if ( (waveform_picker_regs->status & 0x02) == 0x02 ) { // [0010] check the f1 full bit

181

swf_f1_ready = true;

181

swf_f1_ready = true;

182

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffddd; // [1111 1101 1101 1101] f1, f0 bits = 0

182

waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffddd; // [1111 1101 1101 1101] f1, f0 bits = 0

183

}

183

}

184

break;

184

break;

185

186

//********

186

//********

187

// DEFAULT

187

// DEFAULT

188

default:

188

default:

189

break;

189

break;

190

}

190

}

191

}

191

}

192

193

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

193

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

194

// RTEMS TASKS

194

// RTEMS TASKS

195

196

rtems_task wfrm_task(rtems_task_argument argument) //used with the waveform picker VHDL IP

196

rtems_task wfrm_task(rtems_task_argument argument) //used with the waveform picker VHDL IP

197

{

197

{

198

/** This RTEMS task is dedicated to the transmission of snapshots of the NORMAL mode.

198

/** This RTEMS task is dedicated to the transmission of snapshots of the NORMAL mode.

199

*

199

*

200

* @param unused is the starting argument of the RTEMS task

200

* @param unused is the starting argument of the RTEMS task

201

*

201

*

202

* The following data packets are sent by this task:

202

* The following data packets are sent by this task:

203

* - TM_LFR_SCIENCE_NORMAL_SWF_F0

203

* - TM_LFR_SCIENCE_NORMAL_SWF_F0

204

* - TM_LFR_SCIENCE_NORMAL_SWF_F1

204

* - TM_LFR_SCIENCE_NORMAL_SWF_F1

205

* - TM_LFR_SCIENCE_NORMAL_SWF_F2

205

* - TM_LFR_SCIENCE_NORMAL_SWF_F2

206

*

206

*

207

*/

207

*/

208

209

rtems_event_set event_out;

209

rtems_event_set event_out;

210

rtems_id queue_id;

210

rtems_id queue_id;

211

rtems_status_code status;

211

rtems_status_code status;

212

213

init_header_snapshot_wf_table( SID_NORM_SWF_F0, headerSWF_F0 );

213

init_header_snapshot_wf_table( SID_NORM_SWF_F0, headerSWF_F0 );

214

init_header_snapshot_wf_table( SID_NORM_SWF_F1, headerSWF_F1 );

214

init_header_snapshot_wf_table( SID_NORM_SWF_F1, headerSWF_F1 );

215

init_header_snapshot_wf_table( SID_NORM_SWF_F2, headerSWF_F2 );

215

init_header_snapshot_wf_table( SID_NORM_SWF_F2, headerSWF_F2 );

216

217

status = get_message_queue_id_send( &queue_id );

217

status = get_message_queue_id_send( &queue_id );

218

if (status != RTEMS_SUCCESSFUL)

218

if (status != RTEMS_SUCCESSFUL)

219

{

219

{

220

PRINTF1("in WFRM *** ERR get_message_queue_id_send %d\n", status)

220

PRINTF1("in WFRM *** ERR get_message_queue_id_send %d\n", status)

221

}

221

}

222

223

BOOT_PRINTF("in WFRM ***\n")

223

BOOT_PRINTF("in WFRM ***\n")

224

225

while(1){

225

while(1){

226

// wait for an RTEMS_EVENT

226

// wait for an RTEMS_EVENT

227

rtems_event_receive(RTEMS_EVENT_MODE_NORMAL | RTEMS_EVENT_MODE_SBM1

227

rtems_event_receive(RTEMS_EVENT_MODE_NORMAL | RTEMS_EVENT_MODE_SBM1

228

| RTEMS_EVENT_MODE_SBM2 | RTEMS_EVENT_MODE_SBM2_WFRM,

228

| RTEMS_EVENT_MODE_SBM2 | RTEMS_EVENT_MODE_SBM2_WFRM,

229

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

229

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

230

if (event_out == RTEMS_EVENT_MODE_NORMAL)

230

if (event_out == RTEMS_EVENT_MODE_NORMAL)

231

{

231

{

232

DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_NORMAL\n")

232

DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_NORMAL\n")

233

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);

233

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);

234

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f1->buffer_address, SID_NORM_SWF_F1, headerSWF_F1, queue_id);

234

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f1->buffer_address, SID_NORM_SWF_F1, headerSWF_F1, queue_id);

235

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f2->buffer_address, SID_NORM_SWF_F2, headerSWF_F2, queue_id);

235

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f2->buffer_address, SID_NORM_SWF_F2, headerSWF_F2, queue_id);

236

}

236

}

237

if (event_out == RTEMS_EVENT_MODE_SBM1)

237

if (event_out == RTEMS_EVENT_MODE_SBM1)

238

{

238

{

239

DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_SBM1\n")

239

DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_SBM1\n")

240

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);

240

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);

241

send_waveform_SWF((volatile int*) wf_snap_extracted , SID_NORM_SWF_F1, headerSWF_F1, queue_id);

241

send_waveform_SWF((volatile int*) wf_snap_extracted , SID_NORM_SWF_F1, headerSWF_F1, queue_id);

242

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f2->buffer_address, SID_NORM_SWF_F2, headerSWF_F2, queue_id);

242

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f2->buffer_address, SID_NORM_SWF_F2, headerSWF_F2, queue_id);

243

}

243

}

244

if (event_out == RTEMS_EVENT_MODE_SBM2)

244

if (event_out == RTEMS_EVENT_MODE_SBM2)

245

{

245

{

246

DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_SBM2\n")

246

DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_SBM2\n")

247

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);

247

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);

248

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f1->buffer_address, SID_NORM_SWF_F1, headerSWF_F1, queue_id);

248

send_waveform_SWF((volatile int*) ring_node_to_send_swf_f1->buffer_address, SID_NORM_SWF_F1, headerSWF_F1, queue_id);

249

send_waveform_SWF((volatile int*) wf_snap_extracted , SID_NORM_SWF_F2, headerSWF_F2, queue_id);

249

send_waveform_SWF((volatile int*) wf_snap_extracted , SID_NORM_SWF_F2, headerSWF_F2, queue_id);

250

}

250

}

251

}

251

}

252

}

252

}

253

254

rtems_task cwf3_task(rtems_task_argument argument) //used with the waveform picker VHDL IP

254

rtems_task cwf3_task(rtems_task_argument argument) //used with the waveform picker VHDL IP

255

{

255

{

256

/** This RTEMS task is dedicated to the transmission of continuous waveforms at f3.

256

/** This RTEMS task is dedicated to the transmission of continuous waveforms at f3.

257

*

257

*

258

* @param unused is the starting argument of the RTEMS task

258

* @param unused is the starting argument of the RTEMS task

259

*

259

*

260

* The following data packet is sent by this task:

260

* The following data packet is sent by this task:

261

* - TM_LFR_SCIENCE_NORMAL_CWF_F3

261

* - TM_LFR_SCIENCE_NORMAL_CWF_F3

262

*

262

*

263

*/

263

*/

264

265

rtems_event_set event_out;

265

rtems_event_set event_out;

266

rtems_id queue_id;

266

rtems_id queue_id;

267

rtems_status_code status;

267

rtems_status_code status;

268

269

init_header_continuous_wf_table( SID_NORM_CWF_LONG_F3, headerCWF_F3 );

269

init_header_continuous_wf_table( SID_NORM_CWF_LONG_F3, headerCWF_F3 );

270

init_header_continuous_cwf3_light_table( headerCWF_F3_light );

270

init_header_continuous_cwf3_light_table( headerCWF_F3_light );

271

272

status = get_message_queue_id_send( &queue_id );

272

status = get_message_queue_id_send( &queue_id );

273

if (status != RTEMS_SUCCESSFUL)

273

if (status != RTEMS_SUCCESSFUL)

274

{

274

{

275

PRINTF1("in CWF3 *** ERR get_message_queue_id_send %d\n", status)

275

PRINTF1("in CWF3 *** ERR get_message_queue_id_send %d\n", status)

276

}

276

}

277

278

BOOT_PRINTF("in CWF3 ***\n")

278

BOOT_PRINTF("in CWF3 ***\n")

279

280

while(1){

280

while(1){

281

// wait for an RTEMS_EVENT

281

// wait for an RTEMS_EVENT

282

rtems_event_receive( RTEMS_EVENT_0,

282

rtems_event_receive( RTEMS_EVENT_0,

283

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

283

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

284

if ( (lfrCurrentMode == LFR_MODE_NORMAL)

284

if ( (lfrCurrentMode == LFR_MODE_NORMAL)

285

|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode==LFR_MODE_SBM2) )

285

|| (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode==LFR_MODE_SBM2) )

286

{

286

{

287

if ( (parameter_dump_packet.sy_lfr_n_cwf_long_f3 & 0x01) == 0x01)

287

if ( (parameter_dump_packet.sy_lfr_n_cwf_long_f3 & 0x01) == 0x01)

288

{

288

{

289

PRINTF("send CWF_LONG_F3\n")

289

PRINTF("send CWF_LONG_F3\n")

290

send_waveform_CWF(

290

send_waveform_CWF(

291

(volatile int*) ring_node_to_send_cwf_f3->buffer_address,

291

(volatile int*) ring_node_to_send_cwf_f3->buffer_address,

292

SID_NORM_CWF_LONG_F3, headerCWF_F3, queue_id );

292

SID_NORM_CWF_LONG_F3, headerCWF_F3, queue_id );

293

}

293

}

294

else

294

else

295

{

295

{

296

PRINTF("send CWF_F3 (light)\n")

296

PRINTF("send CWF_F3 (light)\n")

297

send_waveform_CWF3_light(

297

send_waveform_CWF3_light(

298

(volatile int*) ring_node_to_send_cwf_f3->buffer_address,

298

(volatile int*) ring_node_to_send_cwf_f3->buffer_address,

299

headerCWF_F3_light, queue_id );

299

headerCWF_F3_light, queue_id );

300

}

300

}

301

302

}

302

}

303

else

303

else

304

{

304

{

305

PRINTF1("in CWF3 *** lfrCurrentMode is %d, no data will be sent\n", lfrCurrentMode)

305

PRINTF1("in CWF3 *** lfrCurrentMode is %d, no data will be sent\n", lfrCurrentMode)

306

}

306

}

307

}

307

}

308

}

308

}

309

310

rtems_task cwf2_task(rtems_task_argument argument) // ONLY USED IN BURST AND SBM2

310

rtems_task cwf2_task(rtems_task_argument argument) // ONLY USED IN BURST AND SBM2

311

{

311

{

312

/** This RTEMS task is dedicated to the transmission of continuous waveforms at f2.

312

/** This RTEMS task is dedicated to the transmission of continuous waveforms at f2.

313

*

313

*

314

* @param unused is the starting argument of the RTEMS task

314

* @param unused is the starting argument of the RTEMS task

315

*

315

*

316

* The following data packet is sent by this function:

316

* The following data packet is sent by this function:

317

* - TM_LFR_SCIENCE_BURST_CWF_F2

317

* - TM_LFR_SCIENCE_BURST_CWF_F2

318

* - TM_LFR_SCIENCE_SBM2_CWF_F2

318

* - TM_LFR_SCIENCE_SBM2_CWF_F2

319

*

319

*

320

*/

320

*/

321

322

rtems_event_set event_out;

322

rtems_event_set event_out;

323

rtems_id queue_id;

323

rtems_id queue_id;

324

rtems_status_code status;

324

rtems_status_code status;

325

326

init_header_continuous_wf_table( SID_BURST_CWF_F2, headerCWF_F2_BURST );

326

init_header_continuous_wf_table( SID_BURST_CWF_F2, headerCWF_F2_BURST );

327

init_header_continuous_wf_table( SID_SBM2_CWF_F2, headerCWF_F2_SBM2 );

327

init_header_continuous_wf_table( SID_SBM2_CWF_F2, headerCWF_F2_SBM2 );

328

329

status = get_message_queue_id_send( &queue_id );

329

status = get_message_queue_id_send( &queue_id );

330

if (status != RTEMS_SUCCESSFUL)

330

if (status != RTEMS_SUCCESSFUL)

331

{

331

{

332

PRINTF1("in CWF2 *** ERR get_message_queue_id_send %d\n", status)

332

PRINTF1("in CWF2 *** ERR get_message_queue_id_send %d\n", status)

333

}

333

}

334

335

BOOT_PRINTF("in CWF2 ***\n")

335

BOOT_PRINTF("in CWF2 ***\n")

336

337

while(1){

337

while(1){

338

// wait for an RTEMS_EVENT

338

// wait for an RTEMS_EVENT

339

rtems_event_receive( RTEMS_EVENT_MODE_BURST | RTEMS_EVENT_MODE_SBM2,

339

rtems_event_receive( RTEMS_EVENT_MODE_BURST | RTEMS_EVENT_MODE_SBM2,

340

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

340

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

341

if (event_out == RTEMS_EVENT_MODE_BURST)

341

if (event_out == RTEMS_EVENT_MODE_BURST)

342

{

342

{

343

send_waveform_CWF( (volatile int *) ring_node_to_send_cwf_f2->buffer_address, SID_BURST_CWF_F2, headerCWF_F2_BURST, queue_id );

343

send_waveform_CWF( (volatile int *) ring_node_to_send_cwf_f2->buffer_address, SID_BURST_CWF_F2, headerCWF_F2_BURST, queue_id );

344

}

344

}

345

if (event_out == RTEMS_EVENT_MODE_SBM2)

345

if (event_out == RTEMS_EVENT_MODE_SBM2)

346

{

346

{

347

send_waveform_CWF( (volatile int *) ring_node_to_send_cwf_f2->buffer_address, SID_SBM2_CWF_F2, headerCWF_F2_SBM2, queue_id );

347

send_waveform_CWF( (volatile int *) ring_node_to_send_cwf_f2->buffer_address, SID_SBM2_CWF_F2, headerCWF_F2_SBM2, queue_id );

348

// launch snapshot extraction if needed

348

// launch snapshot extraction if needed

349

if (extractSWF == true)

349

if (extractSWF == true)

350

{

350

{

351

ring_node_to_send_swf_f2 = ring_node_to_send_cwf_f2;

351

ring_node_to_send_swf_f2 = ring_node_to_send_cwf_f2;

352

// extract the snapshot

352

// extract the snapshot

353

build_snapshot_from_ring( ring_node_to_send_swf_f2, 2 );

353

build_snapshot_from_ring( ring_node_to_send_swf_f2, 2 );

354

// send the snapshot when built

354

// send the snapshot when built

355

status = rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_SBM2 );

355

status = rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_SBM2 );

356

extractSWF = false;

356

extractSWF = false;

357

}

357

}

358

if (swf_f0_ready && swf_f1_ready)

358

if (swf_f0_ready && swf_f1_ready)

359

{

359

{

360

extractSWF = true;

360

extractSWF = true;

361

swf_f0_ready = false;

361

swf_f0_ready = false;

362

swf_f1_ready = false;

362

swf_f1_ready = false;

363

}

363

}

364

}

364

}

365

}

365

}

366

}

366

}

367

368

rtems_task cwf1_task(rtems_task_argument argument) // ONLY USED IN SBM1

368

rtems_task cwf1_task(rtems_task_argument argument) // ONLY USED IN SBM1

369

{

369

{

370

/** This RTEMS task is dedicated to the transmission of continuous waveforms at f1.

370

/** This RTEMS task is dedicated to the transmission of continuous waveforms at f1.

371

*

371

*

372

* @param unused is the starting argument of the RTEMS task

372

* @param unused is the starting argument of the RTEMS task

373

*

373

*

374

* The following data packet is sent by this function:

374

* The following data packet is sent by this function:

375

* - TM_LFR_SCIENCE_SBM1_CWF_F1

375

* - TM_LFR_SCIENCE_SBM1_CWF_F1

376

*

376

*

377

*/

377

*/

378

379

rtems_event_set event_out;

379

rtems_event_set event_out;

380

rtems_id queue_id;

380

rtems_id queue_id;

381

rtems_status_code status;

381

rtems_status_code status;

382

383

init_header_continuous_wf_table( SID_SBM1_CWF_F1, headerCWF_F1 );

383

init_header_continuous_wf_table( SID_SBM1_CWF_F1, headerCWF_F1 );

384

385

status = get_message_queue_id_send( &queue_id );

385

status = get_message_queue_id_send( &queue_id );

386

if (status != RTEMS_SUCCESSFUL)

386

if (status != RTEMS_SUCCESSFUL)

387

{

387

{

388

PRINTF1("in CWF1 *** ERR get_message_queue_id_send %d\n", status)

388

PRINTF1("in CWF1 *** ERR get_message_queue_id_send %d\n", status)

389

}

389

}

390

391

BOOT_PRINTF("in CWF1 ***\n")

391

BOOT_PRINTF("in CWF1 ***\n")

392

393

while(1){

393

while(1){

394

// wait for an RTEMS_EVENT

394

// wait for an RTEMS_EVENT

395

rtems_event_receive( RTEMS_EVENT_MODE_SBM1,

395

rtems_event_receive( RTEMS_EVENT_MODE_SBM1,

396

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

396

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

397

send_waveform_CWF( (volatile int*) ring_node_to_send_cwf_f1->buffer_address, SID_SBM1_CWF_F1, headerCWF_F1, queue_id );

397

send_waveform_CWF( (volatile int*) ring_node_to_send_cwf_f1->buffer_address, SID_SBM1_CWF_F1, headerCWF_F1, queue_id );

398

// launch snapshot extraction if needed

398

// launch snapshot extraction if needed

399

if (extractSWF == true)

399

if (extractSWF == true)

400

{

400

{

401

ring_node_to_send_swf_f1 = ring_node_to_send_cwf_f1;

401

ring_node_to_send_swf_f1 = ring_node_to_send_cwf_f1;

402

// launch the snapshot extraction

402

// launch the snapshot extraction

403

status = rtems_event_send( Task_id[TASKID_SWBD], RTEMS_EVENT_MODE_SBM1 );

403

status = rtems_event_send( Task_id[TASKID_SWBD], RTEMS_EVENT_MODE_SBM1 );

404

extractSWF = false;

404

extractSWF = false;

405

}

405

}

406

if (swf_f0_ready == true)

406

if (swf_f0_ready == true)

407

{

407

{

408

extractSWF = true;

408

extractSWF = true;

409

swf_f0_ready = false; // this step shall be executed only one time

409

swf_f0_ready = false; // this step shall be executed only one time

410

}

410

}

411

if ((swf_f1_ready == true) && (swf_f2_ready == true)) // swf_f1 is ready after the extraction

411

if ((swf_f1_ready == true) && (swf_f2_ready == true)) // swf_f1 is ready after the extraction

412

{

412

{

413

status = rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_SBM1 );

413

status = rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_SBM1 );

414

swf_f1_ready = false;

414

swf_f1_ready = false;

415

swf_f2_ready = false;

415

swf_f2_ready = false;

416

}

416

}

417

}

417

}

418

}

418

}

419

420

rtems_task swbd_task(rtems_task_argument argument)

420

rtems_task swbd_task(rtems_task_argument argument)

421

{

421

{

422

/** This RTEMS task is dedicated to the building of snapshots from different continuous waveforms buffers.

422

/** This RTEMS task is dedicated to the building of snapshots from different continuous waveforms buffers.

423

*

423

*

424

* @param unused is the starting argument of the RTEMS task

424

* @param unused is the starting argument of the RTEMS task

425

*

425

*

426

*/

426

*/

427

428

rtems_event_set event_out;

428

rtems_event_set event_out;

429

430

BOOT_PRINTF("in SWBD ***\n")

430

BOOT_PRINTF("in SWBD ***\n")

431

432

while(1){

432

while(1){

433

// wait for an RTEMS_EVENT

433

// wait for an RTEMS_EVENT

434

rtems_event_receive( RTEMS_EVENT_MODE_SBM1 | RTEMS_EVENT_MODE_SBM2,

434

rtems_event_receive( RTEMS_EVENT_MODE_SBM1 | RTEMS_EVENT_MODE_SBM2,

435

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

435

RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);

436

if (event_out == RTEMS_EVENT_MODE_SBM1)

436

if (event_out == RTEMS_EVENT_MODE_SBM1)

437

{

437

{

438

build_snapshot_from_ring( ring_node_to_send_swf_f1, 1 );

438

build_snapshot_from_ring( ring_node_to_send_swf_f1, 1 );

439

swf_f1_ready = true; // the snapshot has been extracted and is ready to be sent

439

swf_f1_ready = true; // the snapshot has been extracted and is ready to be sent

440

}

440

}

441

else

441

else

442

{

442

{

443

PRINTF1("in SWBD *** unexpected rtems event received %x\n", (int) event_out)

443

PRINTF1("in SWBD *** unexpected rtems event received %x\n", (int) event_out)

444

}

444

}

445

}

445

}

446

}

446

}

447

448

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

448

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

449

// general functions

449

// general functions

450

451

void WFP_init_rings( void )

451

void WFP_init_rings( void )

452

{

452

{

453

// F0 RING

453

// F0 RING

454

init_waveform_ring( waveform_ring_f0, NB_RING_NODES_F0, wf_snap_f0 );

454

init_waveform_ring( waveform_ring_f0, NB_RING_NODES_F0, wf_snap_f0 );

455

// F1 RING

455

// F1 RING

456

init_waveform_ring( waveform_ring_f1, NB_RING_NODES_F1, wf_snap_f1 );

456

init_waveform_ring( waveform_ring_f1, NB_RING_NODES_F1, wf_snap_f1 );

457

// F2 RING

457

// F2 RING

458

init_waveform_ring( waveform_ring_f2, NB_RING_NODES_F2, wf_snap_f2 );

458

init_waveform_ring( waveform_ring_f2, NB_RING_NODES_F2, wf_snap_f2 );

459

// F3 RING

459

// F3 RING

460

init_waveform_ring( waveform_ring_f3, NB_RING_NODES_F3, wf_cont_f3 );

460

init_waveform_ring( waveform_ring_f3, NB_RING_NODES_F3, wf_cont_f3 );

461

462

DEBUG_PRINTF1("waveform_ring_f0 @%x\n", (unsigned int) waveform_ring_f0)

462

DEBUG_PRINTF1("waveform_ring_f0 @%x\n", (unsigned int) waveform_ring_f0)

463

DEBUG_PRINTF1("waveform_ring_f1 @%x\n", (unsigned int) waveform_ring_f1)

463

DEBUG_PRINTF1("waveform_ring_f1 @%x\n", (unsigned int) waveform_ring_f1)

464

DEBUG_PRINTF1("waveform_ring_f2 @%x\n", (unsigned int) waveform_ring_f2)

464

DEBUG_PRINTF1("waveform_ring_f2 @%x\n", (unsigned int) waveform_ring_f2)

465

DEBUG_PRINTF1("waveform_ring_f3 @%x\n", (unsigned int) waveform_ring_f3)

465

DEBUG_PRINTF1("waveform_ring_f3 @%x\n", (unsigned int) waveform_ring_f3)

466

}

466

}

467

468

void init_waveform_ring(ring_node waveform_ring[], unsigned char nbNodes, volatile int wfrm[] )

468

void init_waveform_ring(ring_node waveform_ring[], unsigned char nbNodes, volatile int wfrm[] )

469

{

469

{

470

unsigned char i;

470

unsigned char i;

471

472

waveform_ring[0].next = (ring_node*) &waveform_ring[ 1 ];

472

waveform_ring[0].next = (ring_node*) &waveform_ring[ 1 ];

473

waveform_ring[0].previous = (ring_node*) &waveform_ring[ nbNodes - 1 ];

473

waveform_ring[0].previous = (ring_node*) &waveform_ring[ nbNodes - 1 ];

474

waveform_ring[0].buffer_address = (int) &wfrm[0];

474

waveform_ring[0].buffer_address = (int) &wfrm[0];

475

476

waveform_ring[nbNodes-1].next = (ring_node*) &waveform_ring[ 0 ];

476

waveform_ring[nbNodes-1].next = (ring_node*) &waveform_ring[ 0 ];

477

waveform_ring[nbNodes-1].previous = (ring_node*) &waveform_ring[ nbNodes - 2 ];

477

waveform_ring[nbNodes-1].previous = (ring_node*) &waveform_ring[ nbNodes - 2 ];

478

waveform_ring[nbNodes-1].buffer_address = (int) &wfrm[ (nbNodes-1) * WFRM_BUFFER ];

478

waveform_ring[nbNodes-1].buffer_address = (int) &wfrm[ (nbNodes-1) * WFRM_BUFFER ];

479

480

for(i=1; i<nbNodes-1; i++)

480

for(i=1; i<nbNodes-1; i++)

481

{

481

{

482

waveform_ring[i].next = (ring_node*) &waveform_ring[ i + 1 ];

482

waveform_ring[i].next = (ring_node*) &waveform_ring[ i + 1 ];

483

waveform_ring[i].previous = (ring_node*) &waveform_ring[ i - 1 ];

483

waveform_ring[i].previous = (ring_node*) &waveform_ring[ i - 1 ];

484

waveform_ring[i].buffer_address = (int) &wfrm[ i * WFRM_BUFFER ];

484

waveform_ring[i].buffer_address = (int) &wfrm[ i * WFRM_BUFFER ];

485

}

485

}

486

}

486

}

487

488

void WFP_reset_current_ring_nodes( void )

488

void WFP_reset_current_ring_nodes( void )

489

{

489

{

490

current_ring_node_f0 = waveform_ring_f0;

490

current_ring_node_f0 = waveform_ring_f0;

491

ring_node_to_send_swf_f0 = waveform_ring_f0;

491

ring_node_to_send_swf_f0 = waveform_ring_f0;

492

493

current_ring_node_f1 = waveform_ring_f1;

493

current_ring_node_f1 = waveform_ring_f1;

494

ring_node_to_send_cwf_f1 = waveform_ring_f1;

494

ring_node_to_send_cwf_f1 = waveform_ring_f1;

495

ring_node_to_send_swf_f1 = waveform_ring_f1;

495

ring_node_to_send_swf_f1 = waveform_ring_f1;

496

497

current_ring_node_f2 = waveform_ring_f2;

497

current_ring_node_f2 = waveform_ring_f2;

498

ring_node_to_send_cwf_f2 = waveform_ring_f2;

498

ring_node_to_send_cwf_f2 = waveform_ring_f2;

499

ring_node_to_send_swf_f2 = waveform_ring_f2;

499

ring_node_to_send_swf_f2 = waveform_ring_f2;

500

501

current_ring_node_f3 = waveform_ring_f3;

501

current_ring_node_f3 = waveform_ring_f3;

502

ring_node_to_send_cwf_f3 = waveform_ring_f3;

502

ring_node_to_send_cwf_f3 = waveform_ring_f3;

503

}

503

}

504

505

int init_header_snapshot_wf_table( unsigned int sid, Header_TM_LFR_SCIENCE_SWF_t *headerSWF)

505

int init_header_snapshot_wf_table( unsigned int sid, Header_TM_LFR_SCIENCE_SWF_t *headerSWF)

506

{

506

{

507

unsigned char i;

507

unsigned char i;

508

509

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

509

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

510

{

510

{

511

headerSWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;

511

headerSWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;

512

headerSWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;

512

headerSWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;

513

headerSWF[ i ].reserved = DEFAULT_RESERVED;

513

headerSWF[ i ].reserved = DEFAULT_RESERVED;

514

headerSWF[ i ].userApplication = CCSDS_USER_APP;

514

headerSWF[ i ].userApplication = CCSDS_USER_APP;

515

headerSWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);

515

headerSWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);

516

headerSWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);

516

headerSWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);

517

headerSWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;

517

headerSWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;

518

if (i == 6)

518

if (i == 6)

519

{

519

{

520

headerSWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_224 >> 8);

520

headerSWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_224 >> 8);

521

headerSWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_224 );

521

headerSWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_224 );

522

headerSWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_224 >> 8);

522

headerSWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_224 >> 8);

523

headerSWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_224 );

523

headerSWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_224 );

524

}

524

}

525

else

525

else

526

{

526

{

527

headerSWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_304 >> 8);

527

headerSWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_304 >> 8);

528

headerSWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_304 );

528

headerSWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_304 );

529

headerSWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_304 >> 8);

529

headerSWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_304 >> 8);

530

headerSWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_304 );

530

headerSWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_304 );

531

}

531

}

532

headerSWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;

532

headerSWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;

533

headerSWF[ i ].pktCnt = DEFAULT_PKTCNT; // PKT_CNT

533

headerSWF[ i ].pktCnt = DEFAULT_PKTCNT; // PKT_CNT

534

headerSWF[ i ].pktNr = i+1; // PKT_NR

534

headerSWF[ i ].pktNr = i+1; // PKT_NR

535

// DATA FIELD HEADER

535

// DATA FIELD HEADER

536

headerSWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;

536

headerSWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;

537

headerSWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type

537

headerSWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type

538

headerSWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype

538

headerSWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype

539

headerSWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;

539

headerSWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;

540

// AUXILIARY DATA HEADER

540

// AUXILIARY DATA HEADER

541

headerSWF[ i ].time[0] = 0x00;

541

headerSWF[ i ].time[0] = 0x00;

542

headerSWF[ i ].time[0] = 0x00;

542

headerSWF[ i ].time[0] = 0x00;

543

headerSWF[ i ].time[0] = 0x00;

543

headerSWF[ i ].time[0] = 0x00;

544

headerSWF[ i ].time[0] = 0x00;

544

headerSWF[ i ].time[0] = 0x00;

545

headerSWF[ i ].time[0] = 0x00;

545

headerSWF[ i ].time[0] = 0x00;

546

headerSWF[ i ].time[0] = 0x00;

546

headerSWF[ i ].time[0] = 0x00;

547

headerSWF[ i ].sid = sid;

547

headerSWF[ i ].sid = sid;

548

headerSWF[ i ].hkBIA = DEFAULT_HKBIA;

548

headerSWF[ i ].hkBIA = DEFAULT_HKBIA;

549

}

549

}

550

return LFR_SUCCESSFUL;

550

return LFR_SUCCESSFUL;

551

}

551

}

552

553

int init_header_continuous_wf_table( unsigned int sid, Header_TM_LFR_SCIENCE_CWF_t *headerCWF )

553

int init_header_continuous_wf_table( unsigned int sid, Header_TM_LFR_SCIENCE_CWF_t *headerCWF )

554

{

554

{

555

unsigned int i;

555

unsigned int i;

556

557

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

557

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

558

{

558

{

559

headerCWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;

559

headerCWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;

560

headerCWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;

560

headerCWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;

561

headerCWF[ i ].reserved = DEFAULT_RESERVED;

561

headerCWF[ i ].reserved = DEFAULT_RESERVED;

562

headerCWF[ i ].userApplication = CCSDS_USER_APP;

562

headerCWF[ i ].userApplication = CCSDS_USER_APP;

563

if ( (sid == SID_SBM1_CWF_F1) || (sid == SID_SBM2_CWF_F2) )

563

if ( (sid == SID_SBM1_CWF_F1) || (sid == SID_SBM2_CWF_F2) )

564

{

564

{

565

headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2 >> 8);

565

headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2 >> 8);

566

headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2);

566

headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2);

567

}

567

}

568

else

568

else

569

{

569

{

570

headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);

570

headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);

571

headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);

571

headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);

572

}

572

}

573

headerCWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;

573

headerCWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;

574

headerCWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_336 >> 8);

574

headerCWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_336 >> 8);

575

headerCWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_336 );

575

headerCWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_336 );

576

headerCWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_CWF >> 8);

576

headerCWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_CWF >> 8);

577

headerCWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_CWF );

577

headerCWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_CWF );

578

headerCWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;

578

headerCWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;

579

// DATA FIELD HEADER

579

// DATA FIELD HEADER

580

headerCWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;

580

headerCWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;

581

headerCWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type

581

headerCWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type

582

headerCWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype

582

headerCWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype

583

headerCWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;

583

headerCWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;

584

// AUXILIARY DATA HEADER

584

// AUXILIARY DATA HEADER

585

headerCWF[ i ].sid = sid;

585

headerCWF[ i ].sid = sid;

586

headerCWF[ i ].hkBIA = DEFAULT_HKBIA;

586

headerCWF[ i ].hkBIA = DEFAULT_HKBIA;

587

headerCWF[ i ].time[0] = 0x00;

587

headerCWF[ i ].time[0] = 0x00;

588

headerCWF[ i ].time[0] = 0x00;

588

headerCWF[ i ].time[0] = 0x00;

589

headerCWF[ i ].time[0] = 0x00;

589

headerCWF[ i ].time[0] = 0x00;

590

headerCWF[ i ].time[0] = 0x00;

590

headerCWF[ i ].time[0] = 0x00;

591

headerCWF[ i ].time[0] = 0x00;

591

headerCWF[ i ].time[0] = 0x00;

592

headerCWF[ i ].time[0] = 0x00;

592

headerCWF[ i ].time[0] = 0x00;

593

}

593

}

594

return LFR_SUCCESSFUL;

594

return LFR_SUCCESSFUL;

595

}

595

}

596

597

int init_header_continuous_cwf3_light_table( Header_TM_LFR_SCIENCE_CWF_t *headerCWF )

597

int init_header_continuous_cwf3_light_table( Header_TM_LFR_SCIENCE_CWF_t *headerCWF )

598

{

598

{

599

unsigned int i;

599

unsigned int i;

600

601

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

601

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

602

{

602

{

603

headerCWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;

603

headerCWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;

604

headerCWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;

604

headerCWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;

605

headerCWF[ i ].reserved = DEFAULT_RESERVED;

605

headerCWF[ i ].reserved = DEFAULT_RESERVED;

606

headerCWF[ i ].userApplication = CCSDS_USER_APP;

606

headerCWF[ i ].userApplication = CCSDS_USER_APP;

607

608

headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);

608

headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);

609

headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);

609

headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);

610

611

headerCWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;

611

headerCWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;

612

headerCWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_672 >> 8);

612

headerCWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_672 >> 8);

613

headerCWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_672 );

613

headerCWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_672 );

614

headerCWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_CWF_SHORT_F3 >> 8);

614

headerCWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_CWF_SHORT_F3 >> 8);

615

headerCWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_CWF_SHORT_F3 );

615

headerCWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_CWF_SHORT_F3 );

616

617

headerCWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;

617

headerCWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;

618

// DATA FIELD HEADER

618

// DATA FIELD HEADER

619

headerCWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;

619

headerCWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;

620

headerCWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type

620

headerCWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type

621

headerCWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype

621

headerCWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype

622

headerCWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;

622

headerCWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;

623

// AUXILIARY DATA HEADER

623

// AUXILIARY DATA HEADER

624

headerCWF[ i ].sid = SID_NORM_CWF_F3;

624

headerCWF[ i ].sid = SID_NORM_CWF_F3;

625

headerCWF[ i ].hkBIA = DEFAULT_HKBIA;

625

headerCWF[ i ].hkBIA = DEFAULT_HKBIA;

626

headerCWF[ i ].time[0] = 0x00;

626

headerCWF[ i ].time[0] = 0x00;

627

headerCWF[ i ].time[0] = 0x00;

627

headerCWF[ i ].time[0] = 0x00;

628

headerCWF[ i ].time[0] = 0x00;

628

headerCWF[ i ].time[0] = 0x00;

629

headerCWF[ i ].time[0] = 0x00;

629

headerCWF[ i ].time[0] = 0x00;

630

headerCWF[ i ].time[0] = 0x00;

630

headerCWF[ i ].time[0] = 0x00;

631

headerCWF[ i ].time[0] = 0x00;

631

headerCWF[ i ].time[0] = 0x00;

632

}

632

}

633

return LFR_SUCCESSFUL;

633

return LFR_SUCCESSFUL;

634

}

634

}

635

636

int send_waveform_SWF( volatile int *waveform, unsigned int sid,

636

int send_waveform_SWF( volatile int *waveform, unsigned int sid,

637

Header_TM_LFR_SCIENCE_SWF_t *headerSWF, rtems_id queue_id )

637

Header_TM_LFR_SCIENCE_SWF_t *headerSWF, rtems_id queue_id )

638

{

638

{

639

/** This function sends SWF CCSDS packets (F2, F1 or F0).

639

/** This function sends SWF CCSDS packets (F2, F1 or F0).

640

*

640

*

641

* @param waveform points to the buffer containing the data that will be send.

641

* @param waveform points to the buffer containing the data that will be send.

642

* @param sid is the source identifier of the data that will be sent.

642

* @param sid is the source identifier of the data that will be sent.

643

* @param headerSWF points to a table of headers that have been prepared for the data transmission.

643

* @param headerSWF points to a table of headers that have been prepared for the data transmission.

644

* @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures

644

* @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures

645

* contain information to setup the transmission of the data packets.

645

* contain information to setup the transmission of the data packets.

646

*

646

*

647

* One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.

647

* One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.

648

*

648

*

649

*/

649

*/

650

651

unsigned int i;

651

unsigned int i;

652

int ret;

652

int ret;

653

unsigned int coarseTime;

653

unsigned int coarseTime;

654

unsigned int fineTime;

654

unsigned int fineTime;

655

rtems_status_code status;

655

rtems_status_code status;

656

spw_ioctl_pkt_send spw_ioctl_send_SWF;

656

spw_ioctl_pkt_send spw_ioctl_send_SWF;

657

658

spw_ioctl_send_SWF.hlen = TM_HEADER_LEN + 4 + 12; // + 4 is for the protocole extra header, + 12 is for the auxiliary header

658

spw_ioctl_send_SWF.hlen = TM_HEADER_LEN + 4 + 12; // + 4 is for the protocole extra header, + 12 is for the auxiliary header

659

spw_ioctl_send_SWF.options = 0;

659

spw_ioctl_send_SWF.options = 0;

660

661

ret = LFR_DEFAULT;

661

ret = LFR_DEFAULT;

662

663

coarseTime = waveform[0];

663

coarseTime = waveform[0];

664

fineTime = waveform[1];

664

fineTime = waveform[1];

665

666

for (i=0; i<7; i++) // send waveform

666

for (i=0; i<7; i++) // send waveform

667

{

667

{

668

spw_ioctl_send_SWF.data = (char*) &waveform[ (i * BLK_NR_304 * NB_WORDS_SWF_BLK) + TIME_OFFSET];

668

spw_ioctl_send_SWF.data = (char*) &waveform[ (i * BLK_NR_304 * NB_WORDS_SWF_BLK) + TIME_OFFSET];

669

spw_ioctl_send_SWF.hdr = (char*) &headerSWF[ i ];

669

spw_ioctl_send_SWF.hdr = (char*) &headerSWF[ i ];

670

// BUILD THE DATA

670

// BUILD THE DATA

671

if (i==6) {

671

if (i==6) {

672

spw_ioctl_send_SWF.dlen = BLK_NR_224 * NB_BYTES_SWF_BLK;

672

spw_ioctl_send_SWF.dlen = BLK_NR_224 * NB_BYTES_SWF_BLK;

673

}

673

}

674

else {

674

else {

675

spw_ioctl_send_SWF.dlen = BLK_NR_304 * NB_BYTES_SWF_BLK;

675

spw_ioctl_send_SWF.dlen = BLK_NR_304 * NB_BYTES_SWF_BLK;

676

}

676

}

677

// SET PACKET SEQUENCE COUNTER

677

// SET PACKET SEQUENCE COUNTER

678

increment_seq_counter_source_id( headerSWF[ i ].packetSequenceControl, sid );

678

increment_seq_counter_source_id( headerSWF[ i ].packetSequenceControl, sid );

679

// SET PACKET TIME

679

// SET PACKET TIME

680

compute_acquisition_time( coarseTime, fineTime, sid, i, headerSWF[ i ].acquisitionTime );

680

compute_acquisition_time( coarseTime, fineTime, sid, i, headerSWF[ i ].acquisitionTime );

681

//

681

//

682

headerSWF[ i ].time[0] = headerSWF[ i ].acquisitionTime[0];

682

headerSWF[ i ].time[0] = headerSWF[ i ].acquisitionTime[0];

683

headerSWF[ i ].time[1] = headerSWF[ i ].acquisitionTime[1];

683

headerSWF[ i ].time[1] = headerSWF[ i ].acquisitionTime[1];

684

headerSWF[ i ].time[2] = headerSWF[ i ].acquisitionTime[2];

684

headerSWF[ i ].time[2] = headerSWF[ i ].acquisitionTime[2];

685

headerSWF[ i ].time[3] = headerSWF[ i ].acquisitionTime[3];

685

headerSWF[ i ].time[3] = headerSWF[ i ].acquisitionTime[3];

686

headerSWF[ i ].time[4] = headerSWF[ i ].acquisitionTime[4];

686

headerSWF[ i ].time[4] = headerSWF[ i ].acquisitionTime[4];

687

headerSWF[ i ].time[5] = headerSWF[ i ].acquisitionTime[5];

687

headerSWF[ i ].time[5] = headerSWF[ i ].acquisitionTime[5];

688

// SEND PACKET

688

// SEND PACKET

689

status = rtems_message_queue_send( queue_id, &spw_ioctl_send_SWF, ACTION_MSG_SPW_IOCTL_SEND_SIZE);

689

status = rtems_message_queue_send( queue_id, &spw_ioctl_send_SWF, ACTION_MSG_SPW_IOCTL_SEND_SIZE);

690

if (status != RTEMS_SUCCESSFUL) {

690

if (status != RTEMS_SUCCESSFUL) {

691

printf("%d-%d, ERR %d\n", sid, i, (int) status);

691

printf("%d-%d, ERR %d\n", sid, i, (int) status);

692

ret = LFR_DEFAULT;

692

ret = LFR_DEFAULT;

693

}

693

}

694

rtems_task_wake_after(TIME_BETWEEN_TWO_SWF_PACKETS); // 300 ms between each packet => 7 * 3 = 21 packets => 6.3 seconds

694

rtems_task_wake_after(TIME_BETWEEN_TWO_SWF_PACKETS); // 300 ms between each packet => 7 * 3 = 21 packets => 6.3 seconds

695

}

695

}

696

697

return ret;

697

return ret;

698

}

698

}

699

700

int send_waveform_CWF(volatile int *waveform, unsigned int sid,

700

int send_waveform_CWF(volatile int *waveform, unsigned int sid,

701

Header_TM_LFR_SCIENCE_CWF_t *headerCWF, rtems_id queue_id)

701

Header_TM_LFR_SCIENCE_CWF_t *headerCWF, rtems_id queue_id)

702

{

702

{

703

/** This function sends CWF CCSDS packets (F2, F1 or F0).

703

/** This function sends CWF CCSDS packets (F2, F1 or F0).

704

*

704

*

705

* @param waveform points to the buffer containing the data that will be send.

705

* @param waveform points to the buffer containing the data that will be send.

706

* @param sid is the source identifier of the data that will be sent.

706

* @param sid is the source identifier of the data that will be sent.

707

* @param headerCWF points to a table of headers that have been prepared for the data transmission.

707

* @param headerCWF points to a table of headers that have been prepared for the data transmission.

708

* @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures

708

* @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures

709

* contain information to setup the transmission of the data packets.

709

* contain information to setup the transmission of the data packets.

710

*

710

*

711

* One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.

711

* One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.

712

*

712

*

713

*/

713

*/

714

715

unsigned int i;

715

unsigned int i;

716

int ret;

716

int ret;

717

unsigned int coarseTime;

717

unsigned int coarseTime;

718

unsigned int fineTime;

718

unsigned int fineTime;

719

rtems_status_code status;

719

rtems_status_code status;

720

spw_ioctl_pkt_send spw_ioctl_send_CWF;

720

spw_ioctl_pkt_send spw_ioctl_send_CWF;

721

722

spw_ioctl_send_CWF.hlen = TM_HEADER_LEN + 4 + 10; // + 4 is for the protocole extra header, + 10 is for the auxiliary header

722

spw_ioctl_send_CWF.hlen = TM_HEADER_LEN + 4 + 10; // + 4 is for the protocole extra header, + 10 is for the auxiliary header

723

spw_ioctl_send_CWF.options = 0;

723

spw_ioctl_send_CWF.options = 0;

724

725

ret = LFR_DEFAULT;

725

ret = LFR_DEFAULT;

726

727

coarseTime = waveform[0];

727

coarseTime = waveform[0];

728

fineTime = waveform[1];

728

fineTime = waveform[1];

729

730

for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF; i++) // send waveform

730

for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF; i++) // send waveform

731

{

731

{

732

spw_ioctl_send_CWF.data = (char*) &waveform[ (i * BLK_NR_CWF * NB_WORDS_SWF_BLK) + TIME_OFFSET];

732

spw_ioctl_send_CWF.data = (char*) &waveform[ (i * BLK_NR_CWF * NB_WORDS_SWF_BLK) + TIME_OFFSET];

733

spw_ioctl_send_CWF.hdr = (char*) &headerCWF[ i ];

733

spw_ioctl_send_CWF.hdr = (char*) &headerCWF[ i ];

734

// BUILD THE DATA

734

// BUILD THE DATA

735

spw_ioctl_send_CWF.dlen = BLK_NR_CWF * NB_BYTES_SWF_BLK;

735

spw_ioctl_send_CWF.dlen = BLK_NR_CWF * NB_BYTES_SWF_BLK;

736

// SET PACKET SEQUENCE COUNTER

736

// SET PACKET SEQUENCE COUNTER

737

increment_seq_counter_source_id( headerCWF[ i ].packetSequenceControl, sid );

737

increment_seq_counter_source_id( headerCWF[ i ].packetSequenceControl, sid );

738

// SET PACKET TIME

738

// SET PACKET TIME

739

compute_acquisition_time( coarseTime, fineTime, sid, i, headerCWF[ i ].acquisitionTime);

739

compute_acquisition_time( coarseTime, fineTime, sid, i, headerCWF[ i ].acquisitionTime);

740

//

740

//

741

headerCWF[ i ].time[0] = headerCWF[ i ].acquisitionTime[0];

741

headerCWF[ i ].time[0] = headerCWF[ i ].acquisitionTime[0];

742

headerCWF[ i ].time[1] = headerCWF[ i ].acquisitionTime[1];

742

headerCWF[ i ].time[1] = headerCWF[ i ].acquisitionTime[1];

743

headerCWF[ i ].time[2] = headerCWF[ i ].acquisitionTime[2];

743

headerCWF[ i ].time[2] = headerCWF[ i ].acquisitionTime[2];

744

headerCWF[ i ].time[3] = headerCWF[ i ].acquisitionTime[3];

744

headerCWF[ i ].time[3] = headerCWF[ i ].acquisitionTime[3];

745

headerCWF[ i ].time[4] = headerCWF[ i ].acquisitionTime[4];

745

headerCWF[ i ].time[4] = headerCWF[ i ].acquisitionTime[4];

746

headerCWF[ i ].time[5] = headerCWF[ i ].acquisitionTime[5];

746

headerCWF[ i ].time[5] = headerCWF[ i ].acquisitionTime[5];

747

// SEND PACKET

747

// SEND PACKET

748

if (sid == SID_NORM_CWF_LONG_F3)

748

if (sid == SID_NORM_CWF_LONG_F3)

749

{

749

{

750

status = rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));

750

status = rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));

751

if (status != RTEMS_SUCCESSFUL) {

751

if (status != RTEMS_SUCCESSFUL) {

752

printf("%d-%d, ERR %d\n", sid, i, (int) status);

752

printf("%d-%d, ERR %d\n", sid, i, (int) status);

753

ret = LFR_DEFAULT;

753

ret = LFR_DEFAULT;

754

}

754

}

755

rtems_task_wake_after(TIME_BETWEEN_TWO_CWF3_PACKETS);

755

rtems_task_wake_after(TIME_BETWEEN_TWO_CWF3_PACKETS);

756

}

756

}

757

else

757

else

758

{

758

{

759

status = rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));

759

status = rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));

760

if (status != RTEMS_SUCCESSFUL) {

760

if (status != RTEMS_SUCCESSFUL) {

761

printf("%d-%d, ERR %d\n", sid, i, (int) status);

761

printf("%d-%d, ERR %d\n", sid, i, (int) status);

762

ret = LFR_DEFAULT;

762

ret = LFR_DEFAULT;

763

}

763

}

764

}

764

}

765

}

765

}

766

767

return ret;

767

return ret;

768

}

768

}

769

770

int send_waveform_CWF3_light(volatile int *waveform, Header_TM_LFR_SCIENCE_CWF_t *headerCWF, rtems_id queue_id)

770

int send_waveform_CWF3_light(volatile int *waveform, Header_TM_LFR_SCIENCE_CWF_t *headerCWF, rtems_id queue_id)

771

{

771

{

772

/** This function sends CWF_F3 CCSDS packets without the b1, b2 and b3 data.

772

/** This function sends CWF_F3 CCSDS packets without the b1, b2 and b3 data.

773

*

773

*

774

* @param waveform points to the buffer containing the data that will be send.

774

* @param waveform points to the buffer containing the data that will be send.

775

* @param headerCWF points to a table of headers that have been prepared for the data transmission.

775

* @param headerCWF points to a table of headers that have been prepared for the data transmission.

776

* @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures

776

* @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures

777

* contain information to setup the transmission of the data packets.

777

* contain information to setup the transmission of the data packets.

778

*

778

*

779

* By default, CWF_F3 packet are send without the b1, b2 and b3 data. This function rebuilds a data buffer

779

* By default, CWF_F3 packet are send without the b1, b2 and b3 data. This function rebuilds a data buffer

780

* from the incoming data and sends it in 7 packets, 6 containing 340 blocks and 1 one containing 8 blocks.

780

* from the incoming data and sends it in 7 packets, 6 containing 340 blocks and 1 one containing 8 blocks.

781

*

781

*

782

*/

782

*/

783

784

unsigned int i;

784

unsigned int i;

785

int ret;

785

int ret;

786

unsigned int coarseTime;

786

unsigned int coarseTime;

787

unsigned int fineTime;

787

unsigned int fineTime;

788

rtems_status_code status;

788

rtems_status_code status;

789

spw_ioctl_pkt_send spw_ioctl_send_CWF;

789

spw_ioctl_pkt_send spw_ioctl_send_CWF;

790

char *sample;

790

char *sample;

791

792

spw_ioctl_send_CWF.hlen = TM_HEADER_LEN + 4 + 10; // + 4 is for the protocole extra header, + 10 is for the auxiliary header

792

spw_ioctl_send_CWF.hlen = TM_HEADER_LEN + 4 + 10; // + 4 is for the protocole extra header, + 10 is for the auxiliary header

793

spw_ioctl_send_CWF.options = 0;

793

spw_ioctl_send_CWF.options = 0;

794

795

ret = LFR_DEFAULT;

795

ret = LFR_DEFAULT;

796

797

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

797

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

798

// BUILD CWF3_light DATA

798

// BUILD CWF3_light DATA

799

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

799

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

800

{

800

{

801

sample = (char*) &waveform[ (i * NB_WORDS_SWF_BLK) + TIME_OFFSET ];

801

sample = (char*) &waveform[ (i * NB_WORDS_SWF_BLK) + TIME_OFFSET ];

802

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + TIME_OFFSET_IN_BYTES ] = sample[ 0 ];

802

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + TIME_OFFSET_IN_BYTES ] = sample[ 0 ];

803

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 1 + TIME_OFFSET_IN_BYTES ] = sample[ 1 ];

803

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 1 + TIME_OFFSET_IN_BYTES ] = sample[ 1 ];

804

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 2 + TIME_OFFSET_IN_BYTES ] = sample[ 2 ];

804

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 2 + TIME_OFFSET_IN_BYTES ] = sample[ 2 ];

805

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 3 + TIME_OFFSET_IN_BYTES ] = sample[ 3 ];

805

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 3 + TIME_OFFSET_IN_BYTES ] = sample[ 3 ];

806

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 4 + TIME_OFFSET_IN_BYTES ] = sample[ 4 ];

806

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 4 + TIME_OFFSET_IN_BYTES ] = sample[ 4 ];

807

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 5 + TIME_OFFSET_IN_BYTES ] = sample[ 5 ];

807

wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 5 + TIME_OFFSET_IN_BYTES ] = sample[ 5 ];

808

}

808

}

809

810

coarseTime = waveform[0];

810

coarseTime = waveform[0];

811

fineTime = waveform[1];

811

fineTime = waveform[1];

812

813

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

813

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

814

// SEND CWF3_light DATA

814

// SEND CWF3_light DATA

815

for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF_LIGHT; i++) // send waveform

815

for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF_LIGHT; i++) // send waveform

816

{

816

{

817

spw_ioctl_send_CWF.data = (char*) &wf_cont_f3_light[ (i * BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK) + TIME_OFFSET_IN_BYTES];

817

spw_ioctl_send_CWF.data = (char*) &wf_cont_f3_light[ (i * BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK) + TIME_OFFSET_IN_BYTES];

818

spw_ioctl_send_CWF.hdr = (char*) &headerCWF[ i ];

818

spw_ioctl_send_CWF.hdr = (char*) &headerCWF[ i ];

819

// BUILD THE DATA

819

// BUILD THE DATA

820

spw_ioctl_send_CWF.dlen = BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK;

820

spw_ioctl_send_CWF.dlen = BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK;

821

// SET PACKET SEQUENCE COUNTER

821

// SET PACKET SEQUENCE COUNTER

822

increment_seq_counter_source_id( headerCWF[ i ].packetSequenceControl, SID_NORM_CWF_F3 );

822

increment_seq_counter_source_id( headerCWF[ i ].packetSequenceControl, SID_NORM_CWF_F3 );

823

// SET PACKET TIME

823

// SET PACKET TIME

824

compute_acquisition_time( coarseTime, fineTime, SID_NORM_CWF_F3, i, headerCWF[ i ].acquisitionTime );

824

compute_acquisition_time( coarseTime, fineTime, SID_NORM_CWF_F3, i, headerCWF[ i ].acquisitionTime );

825

//

825

//

826

headerCWF[ i ].time[0] = headerCWF[ i ].acquisitionTime[0];

826

headerCWF[ i ].time[0] = headerCWF[ i ].acquisitionTime[0];

827

headerCWF[ i ].time[1] = headerCWF[ i ].acquisitionTime[1];

827

headerCWF[ i ].time[1] = headerCWF[ i ].acquisitionTime[1];

828

headerCWF[ i ].time[2] = headerCWF[ i ].acquisitionTime[2];

828

headerCWF[ i ].time[2] = headerCWF[ i ].acquisitionTime[2];

829

headerCWF[ i ].time[3] = headerCWF[ i ].acquisitionTime[3];

829

headerCWF[ i ].time[3] = headerCWF[ i ].acquisitionTime[3];

830

headerCWF[ i ].time[4] = headerCWF[ i ].acquisitionTime[4];

830

headerCWF[ i ].time[4] = headerCWF[ i ].acquisitionTime[4];

831

headerCWF[ i ].time[5] = headerCWF[ i ].acquisitionTime[5];

831

headerCWF[ i ].time[5] = headerCWF[ i ].acquisitionTime[5];

832

// SEND PACKET

832

// SEND PACKET

833

status = rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));

833

status = rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));

834

if (status != RTEMS_SUCCESSFUL) {

834

if (status != RTEMS_SUCCESSFUL) {

835

printf("%d-%d, ERR %d\n", SID_NORM_CWF_F3, i, (int) status);

835

printf("%d-%d, ERR %d\n", SID_NORM_CWF_F3, i, (int) status);

836

ret = LFR_DEFAULT;

836

ret = LFR_DEFAULT;

837

}

837

}

838

rtems_task_wake_after(TIME_BETWEEN_TWO_CWF3_PACKETS);

838

rtems_task_wake_after(TIME_BETWEEN_TWO_CWF3_PACKETS);

839

}

839

}

840

841

return ret;

841

return ret;

842

}

842

}

843

844

void compute_acquisition_time_old( unsigned int coarseTime, unsigned int fineTime,

844

void compute_acquisition_time_old( unsigned int coarseTime, unsigned int fineTime,

845

unsigned int sid, unsigned char pa_lfr_pkt_nr, unsigned char * acquisitionTime )

845

unsigned int sid, unsigned char pa_lfr_pkt_nr, unsigned char * acquisitionTime )

846

{

846

{

847

unsigned long long int acquisitionTimeAsLong;

847

unsigned long long int acquisitionTimeAsLong;

848

unsigned char localAcquisitionTime[6];

848

unsigned char localAcquisitionTime[6];

849

double deltaT;

849

double deltaT;

850

851

deltaT = 0.;

851

deltaT = 0.;

852

853

localAcquisitionTime[0] = (unsigned char) ( coarseTime >> 8 );

853

localAcquisitionTime[0] = (unsigned char) ( coarseTime >> 8 );

854

localAcquisitionTime[1] = (unsigned char) ( coarseTime );

854

localAcquisitionTime[1] = (unsigned char) ( coarseTime );

855

localAcquisitionTime[2] = (unsigned char) ( coarseTime >> 24 );

855

localAcquisitionTime[2] = (unsigned char) ( coarseTime >> 24 );

856

localAcquisitionTime[3] = (unsigned char) ( coarseTime >> 16 );

856

localAcquisitionTime[3] = (unsigned char) ( coarseTime >> 16 );

857

localAcquisitionTime[4] = (unsigned char) ( fineTime >> 24 );

857

localAcquisitionTime[4] = (unsigned char) ( fineTime >> 24 );

858

localAcquisitionTime[5] = (unsigned char) ( fineTime >> 16 );

858

localAcquisitionTime[5] = (unsigned char) ( fineTime >> 16 );

859

860

acquisitionTimeAsLong = ( (unsigned long long int) localAcquisitionTime[0] << 40 )

860

acquisitionTimeAsLong = ( (unsigned long long int) localAcquisitionTime[0] << 40 )

861

+ ( (unsigned long long int) localAcquisitionTime[1] << 32 )

861

+ ( (unsigned long long int) localAcquisitionTime[1] << 32 )

862

+ ( localAcquisitionTime[2] << 24 )

862

+ ( localAcquisitionTime[2] << 24 )

863

+ ( localAcquisitionTime[3] << 16 )

863

+ ( localAcquisitionTime[3] << 16 )

864

+ ( localAcquisitionTime[4] << 8 )

864

+ ( localAcquisitionTime[4] << 8 )

865

+ ( localAcquisitionTime[5] );

865

+ ( localAcquisitionTime[5] );

866

867

switch( sid )

867

switch( sid )

868

{

868

{

869

case SID_NORM_SWF_F0:

869

case SID_NORM_SWF_F0:

870

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 24576. ;

870

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 24576. ;

871

break;

871

break;

872

873

case SID_NORM_SWF_F1:

873

case SID_NORM_SWF_F1:

874

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 4096. ;

874

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 4096. ;

875

break;

875

break;

876

877

case SID_NORM_SWF_F2:

877

case SID_NORM_SWF_F2:

878

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 256. ;

878

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 256. ;

879

break;

879

break;

880

881

case SID_SBM1_CWF_F1:

881

case SID_SBM1_CWF_F1:

882

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 4096. ;

882

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 4096. ;

883

break;

883

break;

884

885

case SID_SBM2_CWF_F2:

885

case SID_SBM2_CWF_F2:

886

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;

886

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;

887

break;

887

break;

888

889

case SID_BURST_CWF_F2:

889

case SID_BURST_CWF_F2:

890

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;

890

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;

891

break;

891

break;

892

893

case SID_NORM_CWF_F3:

893

case SID_NORM_CWF_F3:

894

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF_SHORT_F3 * 65536. / 16. ;

894

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF_SHORT_F3 * 65536. / 16. ;

895

break;

895

break;

896

897

case SID_NORM_CWF_LONG_F3:

897

case SID_NORM_CWF_LONG_F3:

898

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 16. ;

898

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 16. ;

899

break;

899

break;

900

901

default:

901

default:

902

PRINTF1("in compute_acquisition_time *** ERR unexpected sid %d", sid)

902

PRINTF1("in compute_acquisition_time *** ERR unexpected sid %d", sid)

903

deltaT = 0.;

903

deltaT = 0.;

904

break;

904

break;

905

}

905

}

906

907

acquisitionTimeAsLong = acquisitionTimeAsLong + (unsigned long long int) deltaT;

907

acquisitionTimeAsLong = acquisitionTimeAsLong + (unsigned long long int) deltaT;

908

//

908

//

909

acquisitionTime[0] = (unsigned char) (acquisitionTimeAsLong >> 40);

909

acquisitionTime[0] = (unsigned char) (acquisitionTimeAsLong >> 40);

910

acquisitionTime[1] = (unsigned char) (acquisitionTimeAsLong >> 32);

910

acquisitionTime[1] = (unsigned char) (acquisitionTimeAsLong >> 32);

911

acquisitionTime[2] = (unsigned char) (acquisitionTimeAsLong >> 24);

911

acquisitionTime[2] = (unsigned char) (acquisitionTimeAsLong >> 24);

912

acquisitionTime[3] = (unsigned char) (acquisitionTimeAsLong >> 16);

912

acquisitionTime[3] = (unsigned char) (acquisitionTimeAsLong >> 16);

913

acquisitionTime[4] = (unsigned char) (acquisitionTimeAsLong >> 8 );

913

acquisitionTime[4] = (unsigned char) (acquisitionTimeAsLong >> 8 );

914

acquisitionTime[5] = (unsigned char) (acquisitionTimeAsLong );

914

acquisitionTime[5] = (unsigned char) (acquisitionTimeAsLong );

915

916

}

916

}

917

918

void compute_acquisition_time( unsigned int coarseTime, unsigned int fineTime,

918

void compute_acquisition_time( unsigned int coarseTime, unsigned int fineTime,

919

unsigned int sid, unsigned char pa_lfr_pkt_nr, unsigned char * acquisitionTime )

919

unsigned int sid, unsigned char pa_lfr_pkt_nr, unsigned char * acquisitionTime )

920

{

920

{

921

unsigned long long int acquisitionTimeAsLong;

921

unsigned long long int acquisitionTimeAsLong;

922

unsigned char localAcquisitionTime[6];

922

unsigned char localAcquisitionTime[6];

923

double deltaT;

923

double deltaT;

924

925

deltaT = 0.;

925

deltaT = 0.;

926

927

localAcquisitionTime[0] = (unsigned char) ( coarseTime >> 24 );

927

localAcquisitionTime[0] = (unsigned char) ( coarseTime >> 24 );

928

localAcquisitionTime[1] = (unsigned char) ( coarseTime >> 16 );

928

localAcquisitionTime[1] = (unsigned char) ( coarseTime >> 16 );

929

localAcquisitionTime[2] = (unsigned char) ( coarseTime >> 8 );

929

localAcquisitionTime[2] = (unsigned char) ( coarseTime >> 8 );

930

localAcquisitionTime[3] = (unsigned char) ( coarseTime );

930

localAcquisitionTime[3] = (unsigned char) ( coarseTime );

931

localAcquisitionTime[4] = (unsigned char) ( fineTime >> 8 );

931

localAcquisitionTime[4] = (unsigned char) ( fineTime >> 8 );

932

localAcquisitionTime[5] = (unsigned char) ( fineTime );

932

localAcquisitionTime[5] = (unsigned char) ( fineTime );

933

934

acquisitionTimeAsLong = ( (unsigned long long int) localAcquisitionTime[0] << 40 )

934

acquisitionTimeAsLong = ( (unsigned long long int) localAcquisitionTime[0] << 40 )

935

+ ( (unsigned long long int) localAcquisitionTime[1] << 32 )

935

+ ( (unsigned long long int) localAcquisitionTime[1] << 32 )

936

+ ( localAcquisitionTime[2] << 24 )

936

+ ( localAcquisitionTime[2] << 24 )

937

+ ( localAcquisitionTime[3] << 16 )

937

+ ( localAcquisitionTime[3] << 16 )

938

+ ( localAcquisitionTime[4] << 8 )

938

+ ( localAcquisitionTime[4] << 8 )

939

+ ( localAcquisitionTime[5] );

939

+ ( localAcquisitionTime[5] );

940

941

switch( sid )

941

switch( sid )

942

{

942

{

943

case SID_NORM_SWF_F0:

943

case SID_NORM_SWF_F0:

944

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 24576. ;

944

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 24576. ;

945

break;

945

break;

946

947

case SID_NORM_SWF_F1:

947

case SID_NORM_SWF_F1:

948

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 4096. ;

948

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 4096. ;

949

break;

949

break;

950

951

case SID_NORM_SWF_F2:

951

case SID_NORM_SWF_F2:

952

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 256. ;

952

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 256. ;

953

break;

953

break;

954

955

case SID_SBM1_CWF_F1:

955

case SID_SBM1_CWF_F1:

956

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 4096. ;

956

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 4096. ;

957

break;

957

break;

958

959

case SID_SBM2_CWF_F2:

959

case SID_SBM2_CWF_F2:

960

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;

960

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;

961

break;

961

break;

962

963

case SID_BURST_CWF_F2:

963

case SID_BURST_CWF_F2:

964

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;

964

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;

965

break;

965

break;

966

967

case SID_NORM_CWF_F3:

967

case SID_NORM_CWF_F3:

968

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF_SHORT_F3 * 65536. / 16. ;

968

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF_SHORT_F3 * 65536. / 16. ;

969

break;

969

break;

970

971

case SID_NORM_CWF_LONG_F3:

971

case SID_NORM_CWF_LONG_F3:

972

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 16. ;

972

deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 16. ;

973

break;

973

break;

974

975

default:

975

default:

976

PRINTF1("in compute_acquisition_time *** ERR unexpected sid %d", sid)

976

PRINTF1("in compute_acquisition_time *** ERR unexpected sid %d", sid)

977

deltaT = 0.;

977

deltaT = 0.;

978

break;

978

break;

979

}

979

}

980

981

acquisitionTimeAsLong = acquisitionTimeAsLong + (unsigned long long int) deltaT;

981

acquisitionTimeAsLong = acquisitionTimeAsLong + (unsigned long long int) deltaT;

982

//

982

//

983

acquisitionTime[0] = (unsigned char) (acquisitionTimeAsLong >> 40);

983

acquisitionTime[0] = (unsigned char) (acquisitionTimeAsLong >> 40);

984

acquisitionTime[1] = (unsigned char) (acquisitionTimeAsLong >> 32);

984

acquisitionTime[1] = (unsigned char) (acquisitionTimeAsLong >> 32);

985

acquisitionTime[2] = (unsigned char) (acquisitionTimeAsLong >> 24);

985

acquisitionTime[2] = (unsigned char) (acquisitionTimeAsLong >> 24);

986

acquisitionTime[3] = (unsigned char) (acquisitionTimeAsLong >> 16);

986

acquisitionTime[3] = (unsigned char) (acquisitionTimeAsLong >> 16);

987

acquisitionTime[4] = (unsigned char) (acquisitionTimeAsLong >> 8 );

987

acquisitionTime[4] = (unsigned char) (acquisitionTimeAsLong >> 8 );

988

acquisitionTime[5] = (unsigned char) (acquisitionTimeAsLong );

988

acquisitionTime[5] = (unsigned char) (acquisitionTimeAsLong );

989

990

}

990

}

991

992

void build_snapshot_from_ring( ring_node *ring_node_to_send, unsigned char frequencyChannel )

992

void build_snapshot_from_ring( ring_node *ring_node_to_send, unsigned char frequencyChannel )

993

{

993

{

994

unsigned int i;

994

unsigned int i;

995

unsigned long long int centerTime_asLong;

995

unsigned long long int centerTime_asLong;

996

unsigned long long int acquisitionTimeF0_asLong;

996

unsigned long long int acquisitionTimeF0_asLong;

997

unsigned long long int acquisitionTime_asLong;

997

unsigned long long int acquisitionTime_asLong;

998

unsigned long long int bufferAcquisitionTime_asLong;

998

unsigned long long int bufferAcquisitionTime_asLong;

999

unsigned char *ptr1;

999

unsigned char *ptr1;

1000

unsigned char *ptr2;

1000

unsigned char *ptr2;

1001

unsigned char *timeCharPtr;

1001

unsigned char *timeCharPtr;

1002

unsigned char nb_ring_nodes;

1002

unsigned char nb_ring_nodes;

1003

unsigned long long int frequency_asLong;

1003

unsigned long long int frequency_asLong;

1004

unsigned long long int nbTicksPerSample_asLong;

1004

unsigned long long int nbTicksPerSample_asLong;

1005

unsigned long long int nbSamplesPart1_asLong;

1005

unsigned long long int nbSamplesPart1_asLong;

1006

unsigned long long int sampleOffset_asLong;

1006

unsigned long long int sampleOffset_asLong;

1007

1008

unsigned int deltaT_F0;

1008

unsigned int deltaT_F0;

1009

unsigned int deltaT_F1;

1009

unsigned int deltaT_F1;

1010

unsigned long long int deltaT_F2;

1010

unsigned long long int deltaT_F2;

1011

1012

deltaT_F0 = 2731; // (2048. / 24576. / 2.) * 65536. = 2730.667;

1012

deltaT_F0 = 2731; // (2048. / 24576. / 2.) * 65536. = 2730.667;

1013

deltaT_F1 = 16384; // (2048. / 4096. / 2.) * 65536. = 16384;

1013

deltaT_F1 = 16384; // (2048. / 4096. / 2.) * 65536. = 16384;

1014

deltaT_F2 = 262144; // (2048. / 256. / 2.) * 65536. = 262144;

1014

deltaT_F2 = 262144; // (2048. / 256. / 2.) * 65536. = 262144;

1015

sampleOffset_asLong = 0x00;

1015

sampleOffset_asLong = 0x00;

1016

1017

// (1) get the f0 acquisition time

1017

// (1) get the f0 acquisition time

1018

build_acquisition_time( &acquisitionTimeF0_asLong, current_ring_node_f0 );

1018

build_acquisition_time( &acquisitionTimeF0_asLong, current_ring_node_f0 );

1019

1020

// (2) compute the central reference time

1020

// (2) compute the central reference time

1021

centerTime_asLong = acquisitionTimeF0_asLong + deltaT_F0;

1021

centerTime_asLong = acquisitionTimeF0_asLong + deltaT_F0;

1022

1023

// (3) compute the acquisition time of the current snapshot

1023

// (3) compute the acquisition time of the current snapshot

1024

switch(frequencyChannel)

1024

switch(frequencyChannel)

1025

{

1025

{

1026

case 1: // 1 is for F1 = 4096 Hz

1026

case 1: // 1 is for F1 = 4096 Hz

1027

acquisitionTime_asLong = centerTime_asLong - deltaT_F1;

1027

acquisitionTime_asLong = centerTime_asLong - deltaT_F1;

1028

nb_ring_nodes = NB_RING_NODES_F1;

1028

nb_ring_nodes = NB_RING_NODES_F1;

1029

frequency_asLong = 4096;

1029

frequency_asLong = 4096;

1030

nbTicksPerSample_asLong = 16; // 65536 / 4096;

1030

nbTicksPerSample_asLong = 16; // 65536 / 4096;

1031

break;

1031

break;

1032

case 2: // 2 is for F2 = 256 Hz

1032

case 2: // 2 is for F2 = 256 Hz

1033

acquisitionTime_asLong = centerTime_asLong - deltaT_F2;

1033

acquisitionTime_asLong = centerTime_asLong - deltaT_F2;

1034

nb_ring_nodes = NB_RING_NODES_F2;

1034

nb_ring_nodes = NB_RING_NODES_F2;

1035

frequency_asLong = 256;

1035

frequency_asLong = 256;

1036

nbTicksPerSample_asLong = 256; // 65536 / 256;

1036

nbTicksPerSample_asLong = 256; // 65536 / 256;

1037

break;

1037

break;

1038

default:

1038

default:

1039

acquisitionTime_asLong = centerTime_asLong;

1039

acquisitionTime_asLong = centerTime_asLong;

1040

frequency_asLong = 256;

1040

frequency_asLong = 256;

1041

nbTicksPerSample_asLong = 256;

1041

nbTicksPerSample_asLong = 256;

1042

break;

1042

break;

1043

}

1043

}

1044

1045

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

1045

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

1046

// (4) search the ring_node with the acquisition time <= acquisitionTime_asLong

1046

// (4) search the ring_node with the acquisition time <= acquisitionTime_asLong

1047

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

1047

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

1048

{

1048

{

1049

PRINTF1("%d ... ", i)

1049

PRINTF1("%d ... ", i)

1050

build_acquisition_time( &bufferAcquisitionTime_asLong, ring_node_to_send );

1050

build_acquisition_time( &bufferAcquisitionTime_asLong, ring_node_to_send );

1051

if (bufferAcquisitionTime_asLong <= acquisitionTime_asLong)

1051

if (bufferAcquisitionTime_asLong <= acquisitionTime_asLong)

1052

{

1052

{

1053

PRINTF1("buffer found with acquisition time = %llx\n", bufferAcquisitionTime_asLong)

1053

PRINTF1("buffer found with acquisition time = %llx\n", bufferAcquisitionTime_asLong)

1054

break;

1054

break;

1055

}

1055

}

1056

ring_node_to_send = ring_node_to_send->previous;

1056

ring_node_to_send = ring_node_to_send->previous;

1057

}

1057

}

1058

1059

// (5) compute the number of samples to take in the current buffer

1059

// (5) compute the number of samples to take in the current buffer

1060

sampleOffset_asLong = ((acquisitionTime_asLong - bufferAcquisitionTime_asLong) * frequency_asLong ) >> 16;

1060

sampleOffset_asLong = ((acquisitionTime_asLong - bufferAcquisitionTime_asLong) * frequency_asLong ) >> 16;

1061

nbSamplesPart1_asLong = NB_SAMPLES_PER_SNAPSHOT - sampleOffset_asLong;

1061

nbSamplesPart1_asLong = NB_SAMPLES_PER_SNAPSHOT - sampleOffset_asLong;

1062

PRINTF2("sampleOffset_asLong = %llx, nbSamplesPart1_asLong = %llx\n", sampleOffset_asLong, nbSamplesPart1_asLong)

1062

PRINTF2("sampleOffset_asLong = %llx, nbSamplesPart1_asLong = %llx\n", sampleOffset_asLong, nbSamplesPart1_asLong)

1063

1064

// (6) compute the final acquisition time

1064

// (6) compute the final acquisition time

1065

acquisitionTime_asLong = bufferAcquisitionTime_asLong +

1065

acquisitionTime_asLong = bufferAcquisitionTime_asLong +

1066

sampleOffset_asLong * nbTicksPerSample_asLong;

1066

sampleOffset_asLong * nbTicksPerSample_asLong;

1067

1068

// (7) copy the acquisition time at the beginning of the extrated snapshot

1068

// (7) copy the acquisition time at the beginning of the extrated snapshot

1069

ptr1 = (unsigned char*) &acquisitionTime_asLong;

1069

ptr1 = (unsigned char*) &acquisitionTime_asLong;

1070

ptr2 = (unsigned char*) wf_snap_extracted;

1070

ptr2 = (unsigned char*) wf_snap_extracted;

1071

ptr2[0] = ptr1[ 0 + 2 ];

1071

ptr2[0] = ptr1[ 0 + 2 ];

1072

ptr2[1] = ptr1[ 1 + 2 ];

1072

ptr2[1] = ptr1[ 1 + 2 ];

1073

ptr2[2] = ptr1[ 2 + 2 ];

1073

ptr2[2] = ptr1[ 2 + 2 ];

1074

ptr2[3] = ptr1[ 3 + 2 ];

1074

ptr2[3] = ptr1[ 3 + 2 ];

1075

ptr2[6] = ptr1[ 4 + 2 ];

1075

ptr2[6] = ptr1[ 4 + 2 ];

1076

ptr2[7] = ptr1[ 5 + 2 ];

1076

ptr2[7] = ptr1[ 5 + 2 ];

1077

1078

// re set the synchronization bit

1078

// re set the synchronization bit

1079

timeCharPtr = (unsigned char*) ring_node_to_send->buffer_address;

1079

timeCharPtr = (unsigned char*) ring_node_to_send->buffer_address;

1080

ptr2[0] = ptr2[0] | (timeCharPtr[0] & 0x80); // [1000 0000]

1080

ptr2[0] = ptr2[0] | (timeCharPtr[0] & 0x80); // [1000 0000]

1081

1082

if ( (nbSamplesPart1_asLong >= NB_SAMPLES_PER_SNAPSHOT) | (nbSamplesPart1_asLong < 0) )

1082

if ( (nbSamplesPart1_asLong >= NB_SAMPLES_PER_SNAPSHOT) | (nbSamplesPart1_asLong < 0) )

1083

{

1083

{

1084

nbSamplesPart1_asLong = 0;

1084

nbSamplesPart1_asLong = 0;

1085

}

1085

}

1086

// copy the part 1 of the snapshot in the extracted buffer

1086

// copy the part 1 of the snapshot in the extracted buffer

1087

for ( i = 0; i < (nbSamplesPart1_asLong * NB_WORDS_SWF_BLK); i++ )

1087

for ( i = 0; i < (nbSamplesPart1_asLong * NB_WORDS_SWF_BLK); i++ )

1088

{

1088

{

1089

wf_snap_extracted[i + TIME_OFFSET] =

1089

wf_snap_extracted[i + TIME_OFFSET] =

1090

((int*) ring_node_to_send->buffer_address)[i + (sampleOffset_asLong * NB_WORDS_SWF_BLK) + TIME_OFFSET];

1090

((int*) ring_node_to_send->buffer_address)[i + (sampleOffset_asLong * NB_WORDS_SWF_BLK) + TIME_OFFSET];

1091

}

1091

}

1092

// copy the part 2 of the snapshot in the extracted buffer

1092

// copy the part 2 of the snapshot in the extracted buffer

1093

ring_node_to_send = ring_node_to_send->next;

1093

ring_node_to_send = ring_node_to_send->next;

1094

for ( i = (nbSamplesPart1_asLong * NB_WORDS_SWF_BLK); i < (NB_SAMPLES_PER_SNAPSHOT * NB_WORDS_SWF_BLK); i++ )

1094

for ( i = (nbSamplesPart1_asLong * NB_WORDS_SWF_BLK); i < (NB_SAMPLES_PER_SNAPSHOT * NB_WORDS_SWF_BLK); i++ )

1095

{

1095

{

1096

wf_snap_extracted[i + TIME_OFFSET] =

1096

wf_snap_extracted[i + TIME_OFFSET] =

1097

((int*) ring_node_to_send->buffer_address)[(i-(nbSamplesPart1_asLong * NB_WORDS_SWF_BLK)) + TIME_OFFSET];

1097

((int*) ring_node_to_send->buffer_address)[(i-(nbSamplesPart1_asLong * NB_WORDS_SWF_BLK)) + TIME_OFFSET];

1098

}

1098

}

1099

}

1099

}

1100

1101

void build_acquisition_time_old( unsigned long long int *acquisitionTimeAslong, ring_node *current_ring_node )

1101

void build_acquisition_time_old( unsigned long long int *acquisitionTimeAslong, ring_node *current_ring_node )

1102

{

1102

{

1103

unsigned char *acquisitionTimeCharPtr;

1103

unsigned char *acquisitionTimeCharPtr;

1104

1105

acquisitionTimeCharPtr = (unsigned char*) current_ring_node->buffer_address;

1105

acquisitionTimeCharPtr = (unsigned char*) current_ring_node->buffer_address;

1106

1107

*acquisitionTimeAslong = 0x00;

1107

*acquisitionTimeAslong = 0x00;

1108

*acquisitionTimeAslong = ( acquisitionTimeCharPtr[0] << 24 )

1108

*acquisitionTimeAslong = ( acquisitionTimeCharPtr[0] << 24 )

1109

+ ( acquisitionTimeCharPtr[1] << 16 )

1109

+ ( acquisitionTimeCharPtr[1] << 16 )

1110

+ ( (unsigned long long int) (acquisitionTimeCharPtr[2] & 0x7f) << 40 ) // [0111 1111] mask the synchronization bit

1110

+ ( (unsigned long long int) (acquisitionTimeCharPtr[2] & 0x7f) << 40 ) // [0111 1111] mask the synchronization bit

1111

+ ( (unsigned long long int) acquisitionTimeCharPtr[3] << 32 )

1111

+ ( (unsigned long long int) acquisitionTimeCharPtr[3] << 32 )

1112

+ ( acquisitionTimeCharPtr[4] << 8 )

1112

+ ( acquisitionTimeCharPtr[4] << 8 )

1113

+ ( acquisitionTimeCharPtr[5] );

1113

+ ( acquisitionTimeCharPtr[5] );

1114

}

1114

}

1115

1116

void build_acquisition_time( unsigned long long int *acquisitionTimeAslong, ring_node *current_ring_node )

1116

void build_acquisition_time( unsigned long long int *acquisitionTimeAslong, ring_node *current_ring_node )

1117

{

1117

{

1118

unsigned char *acquisitionTimeCharPtr;

1118

unsigned char *acquisitionTimeCharPtr;

1119

1120

acquisitionTimeCharPtr = (unsigned char*) current_ring_node->buffer_address;

1120

acquisitionTimeCharPtr = (unsigned char*) current_ring_node->buffer_address;

1121

1122

*acquisitionTimeAslong = 0x00;

1122

*acquisitionTimeAslong = 0x00;

1123

*acquisitionTimeAslong = ( (unsigned long long int) (acquisitionTimeCharPtr[0] & 0x7f) << 40 ) // [0111 1111] mask the synchronization bit

1123

*acquisitionTimeAslong = ( (unsigned long long int) (acquisitionTimeCharPtr[0] & 0x7f) << 40 ) // [0111 1111] mask the synchronization bit

1124

+ ( (unsigned long long int) acquisitionTimeCharPtr[1] << 32 )

1124

+ ( (unsigned long long int) acquisitionTimeCharPtr[1] << 32 )

1125

+ ( acquisitionTimeCharPtr[2] << 24 )

1125

+ ( acquisitionTimeCharPtr[2] << 24 )

1126

+ ( acquisitionTimeCharPtr[3] << 16 )

1126

+ ( acquisitionTimeCharPtr[3] << 16 )

1127

+ ( acquisitionTimeCharPtr[6] << 8 )

1127

+ ( acquisitionTimeCharPtr[6] << 8 )

1128

+ ( acquisitionTimeCharPtr[7] );

1128

+ ( acquisitionTimeCharPtr[7] );

1129

}

1129

}

1130

1131

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

1131

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

1132

// wfp registers

1132

// wfp registers

1133

void reset_wfp_burst_enable(void)

1133

void reset_wfp_burst_enable(void)

1134

{

1134

{

1135

/** This function resets the waveform picker burst_enable register.

1135

/** This function resets the waveform picker burst_enable register.

1136

*

1136

*

1137

* The burst bits [f2 f1 f0] and the enable bits [f3 f2 f1 f0] are set to 0.

1137

* The burst bits [f2 f1 f0] and the enable bits [f3 f2 f1 f0] are set to 0.

1138

*

1138

*

1139

*/

1139

*/

1140

1141

waveform_picker_regs->run_burst_enable = 0x00; // burst f2, f1, f0 enable f3, f2, f1, f0

1141

waveform_picker_regs->run_burst_enable = 0x00; // burst f2, f1, f0 enable f3, f2, f1, f0

1142

}

1142

}

1143

1144

void reset_wfp_status( void )

1144

void reset_wfp_status( void )

1145

{

1145

{

1146

/** This function resets the waveform picker status register.

1146

/** This function resets the waveform picker status register.

1147

*

1147

*

1148

* All status bits are set to 0 [new_err full_err full].

1148

* All status bits are set to 0 [new_err full_err full].

1149

*

1149

*

1150

*/

1150

*/

1151

1152

waveform_picker_regs->status = 0x00; // burst f2, f1, f0 enable f3, f2, f1, f0

1152

waveform_picker_regs->status = 0x00; // burst f2, f1, f0 enable f3, f2, f1, f0

1153

}

1153

}

1154

1155

void reset_waveform_picker_regs(void)

1155

void reset_waveform_picker_regs(void)

1156

{

1156

{

1157

/** This function resets the waveform picker module registers.

1157

/** This function resets the waveform picker module registers.

1158

*

1158

*

1159

* The registers affected by this function are located at the following offset addresses:

1159

* The registers affected by this function are located at the following offset addresses:

1160

* - 0x00 data_shaping

1160

* - 0x00 data_shaping

1161

* - 0x04 run_burst_enable

1161

* - 0x04 run_burst_enable

1162

* - 0x08 addr_data_f0

1162

* - 0x08 addr_data_f0

1163

* - 0x0C addr_data_f1

1163

* - 0x0C addr_data_f1

1164

* - 0x10 addr_data_f2

1164

* - 0x10 addr_data_f2

1165

* - 0x14 addr_data_f3

1165

* - 0x14 addr_data_f3

1166

* - 0x18 status

1166

* - 0x18 status

1167

* - 0x1C delta_snapshot

1167

* - 0x1C delta_snapshot

1168

* - 0x20 delta_f0

1168

* - 0x20 delta_f0

1169

* - 0x24 delta_f0_2

1169

* - 0x24 delta_f0_2

1170

* - 0x28 delta_f1

1170

* - 0x28 delta_f1

1171

* - 0x2c delta_f2

1171

* - 0x2c delta_f2

1172

* - 0x30 nb_data_by_buffer

1172

* - 0x30 nb_data_by_buffer

1173

* - 0x34 nb_snapshot_param

1173

* - 0x34 nb_snapshot_param

1174

* - 0x38 start_date

1174

* - 0x38 start_date

1175

* - 0x3c nb_word_in_buffer

1175

* - 0x3c nb_word_in_buffer

1176

*

1176

*

1177

*/

1177

*/

1178

1179

set_wfp_data_shaping(); // 0x00 *** R1 R0 SP1 SP0 BW

1179

set_wfp_data_shaping(); // 0x00 *** R1 R0 SP1 SP0 BW

1180

reset_wfp_burst_enable(); // 0x04 *** [run *** burst f2, f1, f0 *** enable f3, f2, f1, f0 ]

1180

reset_wfp_burst_enable(); // 0x04 *** [run *** burst f2, f1, f0 *** enable f3, f2, f1, f0 ]

1181

waveform_picker_regs->addr_data_f0 = current_ring_node_f0->buffer_address; // 0x08

1181

waveform_picker_regs->addr_data_f0 = current_ring_node_f0->buffer_address; // 0x08

1182

waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address; // 0x0c

1182

waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address; // 0x0c

1183

waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address; // 0x10

1183

waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address; // 0x10

1184

waveform_picker_regs->addr_data_f3 = current_ring_node_f3->buffer_address; // 0x14

1184

waveform_picker_regs->addr_data_f3 = current_ring_node_f3->buffer_address; // 0x14

1185

reset_wfp_status(); // 0x18

1185

reset_wfp_status(); // 0x18

1186

//

1186

//

1187

set_wfp_delta_snapshot(); // 0x1c

1187

set_wfp_delta_snapshot(); // 0x1c

1188

set_wfp_delta_f0_f0_2(); // 0x20, 0x24

1188

set_wfp_delta_f0_f0_2(); // 0x20, 0x24

1189

set_wfp_delta_f1(); // 0x28

1189

set_wfp_delta_f1(); // 0x28

1190

set_wfp_delta_f2(); // 0x2c

1190

set_wfp_delta_f2(); // 0x2c

1191

DEBUG_PRINTF1("delta_snapshot %x\n", waveform_picker_regs->delta_snapshot)

1191

DEBUG_PRINTF1("delta_snapshot %x\n", waveform_picker_regs->delta_snapshot)

1192

DEBUG_PRINTF1("delta_f0 %x\n", waveform_picker_regs->delta_f0)

1192

DEBUG_PRINTF1("delta_f0 %x\n", waveform_picker_regs->delta_f0)

1193

DEBUG_PRINTF1("delta_f0_2 %x\n", waveform_picker_regs->delta_f0_2)

1193

DEBUG_PRINTF1("delta_f0_2 %x\n", waveform_picker_regs->delta_f0_2)

1194

DEBUG_PRINTF1("delta_f1 %x\n", waveform_picker_regs->delta_f1)

1194

DEBUG_PRINTF1("delta_f1 %x\n", waveform_picker_regs->delta_f1)

1195

DEBUG_PRINTF1("delta_f2 %x\n", waveform_picker_regs->delta_f2)

1195

DEBUG_PRINTF1("delta_f2 %x\n", waveform_picker_regs->delta_f2)

1196

// 2688 = 8 * 336

1196

// 2688 = 8 * 336

1197

waveform_picker_regs->nb_data_by_buffer = 0xa7f; // 0x30 *** 2688 - 1 => nb samples -1

1197

waveform_picker_regs->nb_data_by_buffer = 0xa7f; // 0x30 *** 2688 - 1 => nb samples -1

1198

waveform_picker_regs->snapshot_param = 0xa80; // 0x34 *** 2688 => nb samples

1198

waveform_picker_regs->snapshot_param = 0xa80; // 0x34 *** 2688 => nb samples

1199

waveform_picker_regs->start_date = 0x00; // 0x38

1199

waveform_picker_regs->start_date = 0x00; // 0x38

1200

waveform_picker_regs->nb_word_in_buffer = 0x1f82; // 0x3c *** 2688 * 3 + 2 = 8066

1200

waveform_picker_regs->nb_word_in_buffer = 0x1f82; // 0x3c *** 2688 * 3 + 2 = 8066

1201

}

1201

}

1202

1203

void set_wfp_data_shaping( void )

1203

void set_wfp_data_shaping( void )

1204

{

1204

{

1205

/** This function sets the data_shaping register of the waveform picker module.

1205

/** This function sets the data_shaping register of the waveform picker module.

1206

*

1206

*

1207

* The value is read from one field of the parameter_dump_packet structure:\n

1207

* The value is read from one field of the parameter_dump_packet structure:\n

1208

* bw_sp0_sp1_r0_r1

1208

* bw_sp0_sp1_r0_r1

1209

*

1209

*

1210

*/

1210

*/

1211

1212

unsigned char data_shaping;

1212

unsigned char data_shaping;

1213

1214

// get the parameters for the data shaping [BW SP0 SP1 R0 R1] in sy_lfr_common1 and configure the register

1214

// get the parameters for the data shaping [BW SP0 SP1 R0 R1] in sy_lfr_common1 and configure the register

1215

// waveform picker : [R1 R0 SP1 SP0 BW]

1215

// waveform picker : [R1 R0 SP1 SP0 BW]

1216

1217

data_shaping = parameter_dump_packet.bw_sp0_sp1_r0_r1;

1217

data_shaping = parameter_dump_packet.bw_sp0_sp1_r0_r1;

1218

1219

waveform_picker_regs->data_shaping =

1219

waveform_picker_regs->data_shaping =

1220

( (data_shaping & 0x10) >> 4 ) // BW

1220

( (data_shaping & 0x10) >> 4 ) // BW

1221

+ ( (data_shaping & 0x08) >> 2 ) // SP0

1221

+ ( (data_shaping & 0x08) >> 2 ) // SP0

1222

+ ( (data_shaping & 0x04) ) // SP1

1222

+ ( (data_shaping & 0x04) ) // SP1

1223

+ ( (data_shaping & 0x02) << 2 ) // R0

1223

+ ( (data_shaping & 0x02) << 2 ) // R0

1224

+ ( (data_shaping & 0x01) << 4 ); // R1

1224

+ ( (data_shaping & 0x01) << 4 ); // R1

1225

}

1225

}

1226

1227

void set_wfp_burst_enable_register( unsigned char mode )

1227

void set_wfp_burst_enable_register( unsigned char mode )

1228

{

1228

{

1229

/** This function sets the waveform picker burst_enable register depending on the mode.

1229

/** This function sets the waveform picker burst_enable register depending on the mode.

1230

*

1230

*

1231

* @param mode is the LFR mode to launch.

1231

* @param mode is the LFR mode to launch.

1232

*

1232

*

1233

* The burst bits shall be before the enable bits.

1233

* The burst bits shall be before the enable bits.

1234

*

1234

*

1235

*/

1235

*/

1236

1237

// [0000 0000] burst f2, f1, f0 enable f3 f2 f1 f0

1237

// [0000 0000] burst f2, f1, f0 enable f3 f2 f1 f0

1238

// the burst bits shall be set first, before the enable bits

1238

// the burst bits shall be set first, before the enable bits

1239

switch(mode) {

1239

switch(mode) {

1240

case(LFR_MODE_NORMAL):

1240

case(LFR_MODE_NORMAL):

1241

waveform_picker_regs->run_burst_enable = 0x00; // [0000 0000] no burst enable

1241

waveform_picker_regs->run_burst_enable = 0x00; // [0000 0000] no burst enable

1242

waveform_picker_regs->run_burst_enable = 0x0f; // [0000 1111] enable f3 f2 f1 f0

1242

waveform_picker_regs->run_burst_enable = 0x0f; // [0000 1111] enable f3 f2 f1 f0

1243

break;

1243

break;

1244

case(LFR_MODE_BURST):

1244

case(LFR_MODE_BURST):

1245

waveform_picker_regs->run_burst_enable = 0x40; // [0100 0000] f2 burst enabled

1245

waveform_picker_regs->run_burst_enable = 0x40; // [0100 0000] f2 burst enabled

1246

// waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x04; // [0100] enable f2

1246

// waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x04; // [0100] enable f2

1247

waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x0c; // [1100] enable f3 AND f2

1247

waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x0c; // [1100] enable f3 AND f2

1248

break;

1248

break;

1249

case(LFR_MODE_SBM1):

1249

case(LFR_MODE_SBM1):

1250

waveform_picker_regs->run_burst_enable = 0x20; // [0010 0000] f1 burst enabled

1250

waveform_picker_regs->run_burst_enable = 0x20; // [0010 0000] f1 burst enabled

1251

waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x0f; // [1111] enable f3 f2 f1 f0

1251

waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x0f; // [1111] enable f3 f2 f1 f0

1252

break;

1252

break;

1253

case(LFR_MODE_SBM2):

1253

case(LFR_MODE_SBM2):

1254

waveform_picker_regs->run_burst_enable = 0x40; // [0100 0000] f2 burst enabled

1254

waveform_picker_regs->run_burst_enable = 0x40; // [0100 0000] f2 burst enabled

1255

waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x0f; // [1111] enable f3 f2 f1 f0

1255

waveform_picker_regs->run_burst_enable = waveform_picker_regs->run_burst_enable | 0x0f; // [1111] enable f3 f2 f1 f0

1256

break;

1256

break;

1257

default:

1257

default:

1258

waveform_picker_regs->run_burst_enable = 0x00; // [0000 0000] no burst enabled, no waveform enabled

1258

waveform_picker_regs->run_burst_enable = 0x00; // [0000 0000] no burst enabled, no waveform enabled

1259

break;

1259

break;

1260

}

1260

}

1261

}

1261

}

1262

1263

void set_wfp_delta_snapshot( void )

1263

void set_wfp_delta_snapshot( void )

1264

{

1264

{

1265

/** This function sets the delta_snapshot register of the waveform picker module.

1265

/** This function sets the delta_snapshot register of the waveform picker module.

1266

*

1266

*

1267

* The value is read from two (unsigned char) of the parameter_dump_packet structure:

1267

* The value is read from two (unsigned char) of the parameter_dump_packet structure:

1268

* - sy_lfr_n_swf_p[0]

1268

* - sy_lfr_n_swf_p[0]

1269

* - sy_lfr_n_swf_p[1]

1269

* - sy_lfr_n_swf_p[1]

1270

*

1270

*

1271

*/

1271

*/

1272

1273

unsigned int delta_snapshot;

1273

unsigned int delta_snapshot;

1274

unsigned int delta_snapshot_in_T2;

1274

unsigned int delta_snapshot_in_T2;

1275

1276

delta_snapshot = parameter_dump_packet.sy_lfr_n_swf_p[0]*256

1276

delta_snapshot = parameter_dump_packet.sy_lfr_n_swf_p[0]*256

1277

+ parameter_dump_packet.sy_lfr_n_swf_p[1];

1277

+ parameter_dump_packet.sy_lfr_n_swf_p[1];

1278

1279

delta_snapshot_in_T2 = delta_snapshot * 256;

1279

delta_snapshot_in_T2 = delta_snapshot * 256;

1280

waveform_picker_regs->delta_snapshot = delta_snapshot_in_T2; // max 4 bytes

1280

waveform_picker_regs->delta_snapshot = delta_snapshot_in_T2 - 1; // max 4 bytes

1281

}

1281

}

1282

1283

void set_wfp_delta_f0_f0_2( void )

1283

void set_wfp_delta_f0_f0_2( void )

1284

{

1284

{

1285

unsigned int delta_snapshot;

1285

unsigned int delta_snapshot;

1286

unsigned int nb_samples_per_snapshot;

1286

unsigned int nb_samples_per_snapshot;

1287

float delta_f0_in_float;

1287

float delta_f0_in_float;

1288

1289

delta_snapshot = waveform_picker_regs->delta_snapshot;

1289

delta_snapshot = waveform_picker_regs->delta_snapshot;

1290

nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];

1290

nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];

1291

delta_f0_in_float =nb_samples_per_snapshot / 2. * ( 1. / 256. - 1. / 24576.) * 256.;

1291

delta_f0_in_float =nb_samples_per_snapshot / 2. * ( 1. / 256. - 1. / 24576.) * 256.;

1292

1293

waveform_picker_regs->delta_f0 = delta_snapshot - floor( delta_f0_in_float );

1293

waveform_picker_regs->delta_f0 = delta_snapshot - floor( delta_f0_in_float );

1294

waveform_picker_regs->delta_f0_2 = 0x7; // max 7 bits

1294

waveform_picker_regs->delta_f0_2 = 0x7; // max 7 bits

1295

}

1295

}

1296

1297

void set_wfp_delta_f1( void )

1297

void set_wfp_delta_f1( void )

1298

{

1298

{

1299

unsigned int delta_snapshot;

1299

unsigned int delta_snapshot;

1300

unsigned int nb_samples_per_snapshot;

1300

unsigned int nb_samples_per_snapshot;

1301

float delta_f1_in_float;

1301

float delta_f1_in_float;

1302

1303

delta_snapshot = waveform_picker_regs->delta_snapshot;

1303

delta_snapshot = waveform_picker_regs->delta_snapshot;

1304

nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];

1304

nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];

1305

delta_f1_in_float = nb_samples_per_snapshot / 2. * ( 1. / 256. - 1. / 4096.) * 256.;

1305

delta_f1_in_float = nb_samples_per_snapshot / 2. * ( 1. / 256. - 1. / 4096.) * 256.;

1306

1307

waveform_picker_regs->delta_f1 = delta_snapshot - floor( delta_f1_in_float );

1307

waveform_picker_regs->delta_f1 = delta_snapshot - floor( delta_f1_in_float );

1308

}

1308

}

1309

1310

void set_wfp_delta_f2()

1310

void set_wfp_delta_f2()

1311

{

1311

{

1312

unsigned int delta_snapshot;

1312

unsigned int delta_snapshot;

1313

unsigned int nb_samples_per_snapshot;

1313

unsigned int nb_samples_per_snapshot;

1314

1315

delta_snapshot = waveform_picker_regs->delta_snapshot;

1315

delta_snapshot = waveform_picker_regs->delta_snapshot;

1316

nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];

1316

nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];

1317

1318

waveform_picker_regs->delta_f2 = delta_snapshot - nb_samples_per_snapshot / 2;

1318

waveform_picker_regs->delta_f2 = delta_snapshot - nb_samples_per_snapshot / 2;

1319

}

1319

}

1320

1321

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

1321

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

1322

// local parameters

1322

// local parameters

1323

1324

void increment_seq_counter_source_id( unsigned char *packet_sequence_control, unsigned int sid )

1324

void increment_seq_counter_source_id( unsigned char *packet_sequence_control, unsigned int sid )

1325

{

1325

{

1326

/** This function increments the parameter "sequence_cnt" depending on the sid passed in argument.

1326

/** This function increments the parameter "sequence_cnt" depending on the sid passed in argument.

1327

*

1327

*

1328

* @param packet_sequence_control is a pointer toward the parameter sequence_cnt to update.

1328

* @param packet_sequence_control is a pointer toward the parameter sequence_cnt to update.

1329

* @param sid is the source identifier of the packet being updated.

1329

* @param sid is the source identifier of the packet being updated.

1330

*

1330

*

1331

* REQ-LFR-SRS-5240 / SSS-CP-FS-590

1331

* REQ-LFR-SRS-5240 / SSS-CP-FS-590

1332

* The sequence counters shall wrap around from 2^14 to zero.

1332

* The sequence counters shall wrap around from 2^14 to zero.

1333

* The sequence counter shall start at zero at startup.

1333

* The sequence counter shall start at zero at startup.

1334

*

1334

*

1335

* REQ-LFR-SRS-5239 / SSS-CP-FS-580

1335

* REQ-LFR-SRS-5239 / SSS-CP-FS-580

1336

* All TM_LFR_SCIENCE_ packets are sent to ground, i.e. destination id = 0

1336

* All TM_LFR_SCIENCE_ packets are sent to ground, i.e. destination id = 0

1337

*

1337

*

1338

*/

1338

*/

1339

1340

unsigned short *sequence_cnt;

1340

unsigned short *sequence_cnt;

1341

unsigned short segmentation_grouping_flag;

1341

unsigned short segmentation_grouping_flag;

1342

unsigned short new_packet_sequence_control;

1342

unsigned short new_packet_sequence_control;

1343

rtems_mode initial_mode_set;

1343

rtems_mode initial_mode_set;

1344

rtems_mode current_mode_set;

1344

rtems_mode current_mode_set;

1345

rtems_status_code status;

1345

rtems_status_code status;

1346

1347

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

1347

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

1348

// CHANGE THE MODE OF THE CALLING RTEMS TASK

1348

// CHANGE THE MODE OF THE CALLING RTEMS TASK

1349

status = rtems_task_mode( RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &initial_mode_set );

1349

status = rtems_task_mode( RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &initial_mode_set );

1350

1351

if ( (sid == SID_NORM_SWF_F0) || (sid == SID_NORM_SWF_F1) || (sid == SID_NORM_SWF_F2)

1351

if ( (sid == SID_NORM_SWF_F0) || (sid == SID_NORM_SWF_F1) || (sid == SID_NORM_SWF_F2)

1352

|| (sid == SID_NORM_CWF_F3) || (sid == SID_NORM_CWF_LONG_F3)

1352

|| (sid == SID_NORM_CWF_F3) || (sid == SID_NORM_CWF_LONG_F3)

1353

|| (sid == SID_BURST_CWF_F2)

1353

|| (sid == SID_BURST_CWF_F2)

1354

|| (sid == SID_NORM_ASM_F0) || (sid == SID_NORM_ASM_F1) || (sid == SID_NORM_ASM_F2)

1354

|| (sid == SID_NORM_ASM_F0) || (sid == SID_NORM_ASM_F1) || (sid == SID_NORM_ASM_F2)

1355

|| (sid == SID_NORM_BP1_F0) || (sid == SID_NORM_BP1_F1) || (sid == SID_NORM_BP1_F2)

1355

|| (sid == SID_NORM_BP1_F0) || (sid == SID_NORM_BP1_F1) || (sid == SID_NORM_BP1_F2)

1356

|| (sid == SID_NORM_BP2_F0) || (sid == SID_NORM_BP2_F1) || (sid == SID_NORM_BP2_F2)

1356

|| (sid == SID_NORM_BP2_F0) || (sid == SID_NORM_BP2_F1) || (sid == SID_NORM_BP2_F2)

1357

|| (sid == SID_BURST_BP1_F0) || (sid == SID_BURST_BP2_F0)

1357

|| (sid == SID_BURST_BP1_F0) || (sid == SID_BURST_BP2_F0)

1358

|| (sid == SID_BURST_BP1_F1) || (sid == SID_BURST_BP2_F1) )

1358

|| (sid == SID_BURST_BP1_F1) || (sid == SID_BURST_BP2_F1) )

1359

{

1359

{

1360

sequence_cnt = (unsigned short *) &sequenceCounters_SCIENCE_NORMAL_BURST;

1360

sequence_cnt = (unsigned short *) &sequenceCounters_SCIENCE_NORMAL_BURST;

1361

}

1361

}

1362

else if ( (sid ==SID_SBM1_CWF_F1) || (sid ==SID_SBM2_CWF_F2)

1362

else if ( (sid ==SID_SBM1_CWF_F1) || (sid ==SID_SBM2_CWF_F2)

1363

|| (sid == SID_SBM1_BP1_F0) || (sid == SID_SBM1_BP2_F0)

1363

|| (sid == SID_SBM1_BP1_F0) || (sid == SID_SBM1_BP2_F0)

1364

|| (sid == SID_SBM2_BP1_F0) || (sid == SID_SBM2_BP2_F0)

1364

|| (sid == SID_SBM2_BP1_F0) || (sid == SID_SBM2_BP2_F0)

1365

|| (sid == SID_SBM2_BP1_F1) || (sid == SID_SBM2_BP2_F1) )

1365

|| (sid == SID_SBM2_BP1_F1) || (sid == SID_SBM2_BP2_F1) )

1366

{

1366

{

1367

sequence_cnt = (unsigned short *) &sequenceCounters_SCIENCE_SBM1_SBM2;

1367

sequence_cnt = (unsigned short *) &sequenceCounters_SCIENCE_SBM1_SBM2;

1368

}

1368

}

1369

else

1369

else

1370

{

1370

{

1371

sequence_cnt = (unsigned short *) NULL;

1371

sequence_cnt = (unsigned short *) NULL;

1372

PRINTF1("in increment_seq_counter_source_id *** ERR apid_destid %d not known\n", sid)

1372

PRINTF1("in increment_seq_counter_source_id *** ERR apid_destid %d not known\n", sid)

1373

}

1373

}

1374

1375

if (sequence_cnt != NULL)

1375

if (sequence_cnt != NULL)

1376

{

1376

{

1377

segmentation_grouping_flag = TM_PACKET_SEQ_CTRL_STANDALONE << 8;

1377

segmentation_grouping_flag = TM_PACKET_SEQ_CTRL_STANDALONE << 8;

1378

*sequence_cnt = (*sequence_cnt) & 0x3fff;

1378

*sequence_cnt = (*sequence_cnt) & 0x3fff;

1379

1380

new_packet_sequence_control = segmentation_grouping_flag | (*sequence_cnt) ;

1380

new_packet_sequence_control = segmentation_grouping_flag | (*sequence_cnt) ;

1381

1382

packet_sequence_control[0] = (unsigned char) (new_packet_sequence_control >> 8);

1382

packet_sequence_control[0] = (unsigned char) (new_packet_sequence_control >> 8);

1383

packet_sequence_control[1] = (unsigned char) (new_packet_sequence_control );

1383

packet_sequence_control[1] = (unsigned char) (new_packet_sequence_control );

1384

1385

// increment the sequence counter

1385

// increment the sequence counter

1386

if ( *sequence_cnt < SEQ_CNT_MAX)

1386

if ( *sequence_cnt < SEQ_CNT_MAX)

1387

{

1387

{

1388

*sequence_cnt = *sequence_cnt + 1;

1388

*sequence_cnt = *sequence_cnt + 1;

1389

}

1389

}

1390

else

1390

else

1391

{

1391

{

1392

*sequence_cnt = 0;

1392

*sequence_cnt = 0;

1393

}

1393

}

1394

}

1394

}

1395

1396

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

1396

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

1397

// RESET THE MODE OF THE CALLING TASK

1397

// RESET THE MODE OF THE CALLING TASK

1398

status = rtems_task_mode( initial_mode_set, RTEMS_PREEMPT_MASK, &current_mode_set );

1398

status = rtems_task_mode( initial_mode_set, RTEMS_PREEMPT_MASK, &current_mode_set );

1399

}

1399

}

	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

             <?xml version="1.0" encoding="UTF-8"?>
             <!DOCTYPE QtCreatorProject>
-            <!-- Written by QtCreator 3.0.1, 2014-06-20T09:37:09. -->
+            <!-- Written by QtCreator 3.0.1, 2014-06-23T07:07:05. -->
             <qtcreator>
              <data>
               <variable>ProjectExplorer.Project.ActiveTarget</variable>
               <value type="int">0</value>
              </data>
              <data>
               <variable>ProjectExplorer.Project.EditorSettings</variable>
               <valuemap type="QVariantMap">
                <value type="bool" key="EditorConfiguration.AutoIndent">true</value>
                <value type="bool" key="EditorConfiguration.AutoSpacesForTabs">false</value>
                <value type="bool" key="EditorConfiguration.CamelCaseNavigation">true</value>
                <valuemap type="QVariantMap" key="EditorConfiguration.CodeStyle.0">
                 <value type="QString" key="language">Cpp</value>
                 <valuemap type="QVariantMap" key="value">
                  <value type="QByteArray" key="CurrentPreferences">CppGlobal</value>
                 </valuemap>
                </valuemap>
                <valuemap type="QVariantMap" key="EditorConfiguration.CodeStyle.1">
                 <value type="QString" key="language">QmlJS</value>
                 <valuemap type="QVariantMap" key="value">
                  <value type="QByteArray" key="CurrentPreferences">QmlJSGlobal</value>
                 </valuemap>
                </valuemap>
                <value type="int" key="EditorConfiguration.CodeStyle.Count">2</value>
                <value type="QByteArray" key="EditorConfiguration.Codec">UTF-8</value>
                <value type="bool" key="EditorConfiguration.ConstrainTooltips">false</value>
                <value type="int" key="EditorConfiguration.IndentSize">4</value>
                <value type="bool" key="EditorConfiguration.KeyboardTooltips">false</value>
                <value type="bool" key="EditorConfiguration.MouseNavigation">true</value>
                <value type="int" key="EditorConfiguration.PaddingMode">1</value>
                <value type="bool" key="EditorConfiguration.ScrollWheelZooming">true</value>
                <value type="int" key="EditorConfiguration.SmartBackspaceBehavior">0</value>
                <value type="bool" key="EditorConfiguration.SpacesForTabs">true</value>
                <value type="int" key="EditorConfiguration.TabKeyBehavior">0</value>
                <value type="int" key="EditorConfiguration.TabSize">8</value>
                <value type="bool" key="EditorConfiguration.UseGlobal">true</value>
                <value type="int" key="EditorConfiguration.Utf8BomBehavior">1</value>
                <value type="bool" key="EditorConfiguration.addFinalNewLine">true</value>
                <value type="bool" key="EditorConfiguration.cleanIndentation">true</value>
                <value type="bool" key="EditorConfiguration.cleanWhitespace">true</value>
                <value type="bool" key="EditorConfiguration.inEntireDocument">false</value>
               </valuemap>
              </data>
              <data>
               <variable>ProjectExplorer.Project.PluginSettings</variable>
               <valuemap type="QVariantMap"/>
              </data>
              <data>
               <variable>ProjectExplorer.Project.Target.0</variable>
               <valuemap type="QVariantMap">
                <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Desktop-Qt 4.8.2 in PATH (System)</value>
                <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName">Desktop-Qt 4.8.2 in PATH (System)</value>
                <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">{5289e843-9ef2-45ce-88c6-ad27d8e08def}</value>
                <value type="int" key="ProjectExplorer.Target.ActiveBuildConfiguration">0</value>
                <value type="int" key="ProjectExplorer.Target.ActiveDeployConfiguration">0</value>
                <value type="int" key="ProjectExplorer.Target.ActiveRunConfiguration">0</value>
                <valuemap type="QVariantMap" key="ProjectExplorer.Target.BuildConfiguration.0">
                 <value type="QString" key="ProjectExplorer.BuildConfiguration.BuildDirectory"></value>
                 <valuemap type="QVariantMap" key="ProjectExplorer.BuildConfiguration.BuildStepList.0">
                  <valuemap type="QVariantMap" key="ProjectExplorer.BuildStepList.Step.0">
                   <value type="bool" key="ProjectExplorer.BuildStep.Enabled">true</value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">qmake</value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">QtProjectManager.QMakeBuildStep</value>
                   <value type="bool" key="QtProjectManager.QMakeBuildStep.LinkQmlDebuggingLibrary">false</value>
                   <value type="bool" key="QtProjectManager.QMakeBuildStep.LinkQmlDebuggingLibraryAuto">false</value>
                   <value type="QString" key="QtProjectManager.QMakeBuildStep.QMakeArguments"></value>
                   <value type="bool" key="QtProjectManager.QMakeBuildStep.QMakeForced">false</value>
                  </valuemap>
                  <valuemap type="QVariantMap" key="ProjectExplorer.BuildStepList.Step.1">
                   <value type="bool" key="ProjectExplorer.BuildStep.Enabled">true</value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Make</value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">Qt4ProjectManager.MakeStep</value>
                   <valuelist type="QVariantList" key="Qt4ProjectManager.MakeStep.AutomaticallyAddedMakeArguments">
                    <value type="QString">-w</value>
                    <value type="QString">-r</value>
                   </valuelist>
                   <value type="bool" key="Qt4ProjectManager.MakeStep.Clean">false</value>
                   <value type="QString" key="Qt4ProjectManager.MakeStep.MakeArguments"></value>
                   <value type="QString" key="Qt4ProjectManager.MakeStep.MakeCommand"></value>
                  </valuemap>
                  <value type="int" key="ProjectExplorer.BuildStepList.StepsCount">2</value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Build</value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">ProjectExplorer.BuildSteps.Build</value>
                 </valuemap>
                 <valuemap type="QVariantMap" key="ProjectExplorer.BuildConfiguration.BuildStepList.1">
                  <valuemap type="QVariantMap" key="ProjectExplorer.BuildStepList.Step.0">
                   <value type="bool" key="ProjectExplorer.BuildStep.Enabled">true</value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Make</value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                   <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">Qt4ProjectManager.MakeStep</value>
                   <valuelist type="QVariantList" key="Qt4ProjectManager.MakeStep.AutomaticallyAddedMakeArguments">
                    <value type="QString">-w</value>
                    <value type="QString">-r</value>
                   </valuelist>
                   <value type="bool" key="Qt4ProjectManager.MakeStep.Clean">true</value>
                   <value type="QString" key="Qt4ProjectManager.MakeStep.MakeArguments">clean</value>
                   <value type="QString" key="Qt4ProjectManager.MakeStep.MakeCommand"></value>
                  </valuemap>
                  <value type="int" key="ProjectExplorer.BuildStepList.StepsCount">1</value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Clean</value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">ProjectExplorer.BuildSteps.Clean</value>
                 </valuemap>
                 <value type="int" key="ProjectExplorer.BuildConfiguration.BuildStepListCount">2</value>
                 <value type="bool" key="ProjectExplorer.BuildConfiguration.ClearSystemEnvironment">false</value>
                 <valuelist type="QVariantList" key="ProjectExplorer.BuildConfiguration.UserEnvironmentChanges"/>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Release</value>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">Qt4ProjectManager.Qt4BuildConfiguration</value>
                 <value type="int" key="Qt4ProjectManager.Qt4BuildConfiguration.BuildConfiguration">0</value>
                 <value type="bool" key="Qt4ProjectManager.Qt4BuildConfiguration.UseShadowBuild">true</value>
                </valuemap>
                <value type="int" key="ProjectExplorer.Target.BuildConfigurationCount">1</value>
                <valuemap type="QVariantMap" key="ProjectExplorer.Target.DeployConfiguration.0">
                 <valuemap type="QVariantMap" key="ProjectExplorer.BuildConfiguration.BuildStepList.0">
                  <value type="int" key="ProjectExplorer.BuildStepList.StepsCount">0</value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Deploy</value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                  <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">ProjectExplorer.BuildSteps.Deploy</value>
                 </valuemap>
                 <value type="int" key="ProjectExplorer.BuildConfiguration.BuildStepListCount">1</value>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Deploy locally</value>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">ProjectExplorer.DefaultDeployConfiguration</value>
                </valuemap>
                <value type="int" key="ProjectExplorer.Target.DeployConfigurationCount">1</value>
                <valuemap type="QVariantMap" key="ProjectExplorer.Target.PluginSettings"/>
                <valuemap type="QVariantMap" key="ProjectExplorer.Target.RunConfiguration.0">
                 <valuelist type="QVariantList" key="Analyzer.Valgrind.AddedSuppressionFiles"/>
                 <value type="bool" key="Analyzer.Valgrind.Callgrind.CollectBusEvents">false</value>
                 <value type="bool" key="Analyzer.Valgrind.Callgrind.CollectSystime">false</value>
                 <value type="bool" key="Analyzer.Valgrind.Callgrind.EnableBranchSim">false</value>
                 <value type="bool" key="Analyzer.Valgrind.Callgrind.EnableCacheSim">false</value>
                 <value type="bool" key="Analyzer.Valgrind.Callgrind.EnableEventToolTips">true</value>
                 <value type="double" key="Analyzer.Valgrind.Callgrind.MinimumCostRatio">0.01</value>
                 <value type="double" key="Analyzer.Valgrind.Callgrind.VisualisationMinimumCostRatio">10</value>
                 <value type="bool" key="Analyzer.Valgrind.FilterExternalIssues">true</value>
                 <value type="int" key="Analyzer.Valgrind.LeakCheckOnFinish">1</value>
                 <value type="int" key="Analyzer.Valgrind.NumCallers">25</value>
                 <valuelist type="QVariantList" key="Analyzer.Valgrind.RemovedSuppressionFiles"/>
                 <value type="int" key="Analyzer.Valgrind.SelfModifyingCodeDetection">1</value>
                 <value type="bool" key="Analyzer.Valgrind.Settings.UseGlobalSettings">true</value>
                 <value type="bool" key="Analyzer.Valgrind.ShowReachable">false</value>
                 <value type="bool" key="Analyzer.Valgrind.TrackOrigins">true</value>
                 <value type="QString" key="Analyzer.Valgrind.ValgrindExecutable">valgrind</value>
                 <valuelist type="QVariantList" key="Analyzer.Valgrind.VisibleErrorKinds">
                  <value type="int">0</value>
                  <value type="int">1</value>
                  <value type="int">2</value>
                  <value type="int">3</value>
                  <value type="int">4</value>
                  <value type="int">5</value>
                  <value type="int">6</value>
                  <value type="int">7</value>
                  <value type="int">8</value>
                  <value type="int">9</value>
                  <value type="int">10</value>
                  <value type="int">11</value>
                  <value type="int">12</value>
                  <value type="int">13</value>
                  <value type="int">14</value>
                 </valuelist>
                 <value type="int" key="PE.EnvironmentAspect.Base">2</value>
                 <valuelist type="QVariantList" key="PE.EnvironmentAspect.Changes"/>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">fsw-qt</value>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
                 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">Qt4ProjectManager.Qt4RunConfiguration:/opt/DEV_PLE/FSW-qt/fsw-qt.pro</value>
                 <value type="QString" key="Qt4ProjectManager.Qt4RunConfiguration.CommandLineArguments"></value>
                 <value type="QString" key="Qt4ProjectManager.Qt4RunConfiguration.ProFile">fsw-qt.pro</value>
                 <value type="bool" key="Qt4ProjectManager.Qt4RunConfiguration.UseDyldImageSuffix">false</value>
                 <value type="bool" key="Qt4ProjectManager.Qt4RunConfiguration.UseTerminal">true</value>
                 <value type="QString" key="Qt4ProjectManager.Qt4RunConfiguration.UserWorkingDirectory"></value>
                 <value type="uint" key="RunConfiguration.QmlDebugServerPort">3768</value>
                 <value type="bool" key="RunConfiguration.UseCppDebugger">true</value>
                 <value type="bool" key="RunConfiguration.UseCppDebuggerAuto">false</value>
                 <value type="bool" key="RunConfiguration.UseMultiProcess">false</value>
                 <value type="bool" key="RunConfiguration.UseQmlDebugger">false</value>
                 <value type="bool" key="RunConfiguration.UseQmlDebuggerAuto">true</value>
                </valuemap>
                <value type="int" key="ProjectExplorer.Target.RunConfigurationCount">1</value>
               </valuemap>
              </data>
              <data>
               <variable>ProjectExplorer.Project.TargetCount</variable>
               <value type="int">1</value>
              </data>
              <data>
               <variable>ProjectExplorer.Project.Updater.EnvironmentId</variable>
               <value type="QByteArray">{2e58a81f-9962-4bba-ae6b-760177f0656c}</value>
              </data>
              <data>
               <variable>ProjectExplorer.Project.Updater.FileVersion</variable>
               <value type="int">15</value>
              </data>
             </qtcreator>

             /** Functions and tasks related to waveform packet generation.
              *
              * @file
              * @author P. LEROY
              *
              * A group of functions to handle waveforms, in snapshot or continuous format.\n
              *
              */
             #include "wf_handler.h"
             //*****************
             // waveform headers
             // SWF
             Header_TM_LFR_SCIENCE_SWF_t headerSWF_F0[7];
             Header_TM_LFR_SCIENCE_SWF_t headerSWF_F1[7];
             Header_TM_LFR_SCIENCE_SWF_t headerSWF_F2[7];
             // CWF
             Header_TM_LFR_SCIENCE_CWF_t headerCWF_F1[       NB_PACKETS_PER_GROUP_OF_CWF         ];
             Header_TM_LFR_SCIENCE_CWF_t headerCWF_F2_BURST[ NB_PACKETS_PER_GROUP_OF_CWF         ];
             Header_TM_LFR_SCIENCE_CWF_t headerCWF_F2_SBM2[  NB_PACKETS_PER_GROUP_OF_CWF         ];
             Header_TM_LFR_SCIENCE_CWF_t headerCWF_F3[       NB_PACKETS_PER_GROUP_OF_CWF         ];
             Header_TM_LFR_SCIENCE_CWF_t headerCWF_F3_light[ NB_PACKETS_PER_GROUP_OF_CWF_LIGHT   ];
             //**************
             // waveform ring
             ring_node waveform_ring_f0[NB_RING_NODES_F0];
             ring_node waveform_ring_f1[NB_RING_NODES_F1];
             ring_node waveform_ring_f2[NB_RING_NODES_F2];
             ring_node waveform_ring_f3[NB_RING_NODES_F3];
             ring_node *current_ring_node_f0;
             ring_node *ring_node_to_send_swf_f0;
             ring_node *current_ring_node_f1;
             ring_node *ring_node_to_send_swf_f1;
             ring_node *ring_node_to_send_cwf_f1;
             ring_node *current_ring_node_f2;
             ring_node *ring_node_to_send_swf_f2;
             ring_node *ring_node_to_send_cwf_f2;
             ring_node *current_ring_node_f3;
             ring_node *ring_node_to_send_cwf_f3;
             bool extractSWF = false;
             bool swf_f0_ready = false;
             bool swf_f1_ready = false;
             bool swf_f2_ready = false;
             int wf_snap_extracted[ (NB_SAMPLES_PER_SNAPSHOT * NB_WORDS_SWF_BLK) + TIME_OFFSET ];
             //*********************
             // Interrupt SubRoutine
             void reset_extractSWF( void )
             {
                 extractSWF = false;
                 swf_f0_ready = false;
                 swf_f1_ready = false;
                 swf_f2_ready = false;
             }
             rtems_isr waveforms_isr( rtems_vector_number vector )
             {
                 /** This is the interrupt sub routine called by the waveform picker core.
                  *
                  * This ISR launch different actions depending mainly on two pieces of information:
                  * 1. the values read in the registers of the waveform picker.
                  * 2. the current LFR mode.
                  *
                  */
                 rtems_status_code status;
                 if ( (lfrCurrentMode == LFR_MODE_NORMAL) || (lfrCurrentMode == LFR_MODE_BURST)  // in BURST the data are used to place v, e1 and e2 in the HK packet
                      || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
                 { // in modes other than STANDBY and BURST, send the CWF_F3 data
                     if ((waveform_picker_regs->status & 0x08) == 0x08){     // [1000] f3 is full
                         // (1) change the receiving buffer for the waveform picker
                         ring_node_to_send_cwf_f3 = current_ring_node_f3;
                         current_ring_node_f3 = current_ring_node_f3->next;
                         waveform_picker_regs->addr_data_f3 = current_ring_node_f3->buffer_address;
                         // (2) send an event for the waveforms transmission
                         if (rtems_event_send( Task_id[TASKID_CWF3], RTEMS_EVENT_0 ) != RTEMS_SUCCESSFUL) {
                             rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );
                         }
                         rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2);
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffff777; // reset f3 bits to 0, [1111 0111 0111 0111]
                     }
                 }
                 switch(lfrCurrentMode)
                 {
                     //********
                     // STANDBY
                     case(LFR_MODE_STANDBY):
                     break;
                     //******
                     // NORMAL
                     case(LFR_MODE_NORMAL):
                     if ( (waveform_picker_regs->status & 0xff8) != 0x00)    // [1000] check the error bits
                     {
                         rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );
                     }
                     if ( (waveform_picker_regs->status & 0x07) == 0x07)    // [0111] check the f2, f1, f0 full bits
                     {
                         // change F0 ring node
                         ring_node_to_send_swf_f0 = current_ring_node_f0;
                         current_ring_node_f0 = current_ring_node_f0->next;
                         waveform_picker_regs->addr_data_f0 = current_ring_node_f0->buffer_address;
                         // change F1 ring node
                         ring_node_to_send_swf_f1 = current_ring_node_f1;
                         current_ring_node_f1 = current_ring_node_f1->next;
                         waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address;
                         // change F2 ring node
                         ring_node_to_send_swf_f2 = current_ring_node_f2;
                         current_ring_node_f2 = current_ring_node_f2->next;
                         waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;
                         //
                         if (rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_NORMAL ) != RTEMS_SUCCESSFUL)
                         {
                             rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );
                         }
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffff888; // [1000 1000 1000]
                     }
                     break;
                     //******
                     // BURST
                     case(LFR_MODE_BURST):
                     if ( (waveform_picker_regs->status & 0x04) == 0x04 ){ // [0100] check the f2 full bit
                         // (1) change the receiving buffer for the waveform picker
                         ring_node_to_send_cwf_f2 = current_ring_node_f2;
                         current_ring_node_f2 = current_ring_node_f2->next;
                         waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;
                         // (2) send an event for the waveforms transmission
                         if (rtems_event_send( Task_id[TASKID_CWF2], RTEMS_EVENT_MODE_BURST ) != RTEMS_SUCCESSFUL) {
                             rtems_event_send( Task_id[TASKID_DUMB], RTEMS_EVENT_2 );
                         }
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bit = 0
                     }
                     break;
                     //*****
                     // SBM1
                     case(LFR_MODE_SBM1):
                     if ( (waveform_picker_regs->status & 0x02) == 0x02 ) { // [0010] check the f1 full bit
                         // (1) change the receiving buffer for the waveform picker
                         ring_node_to_send_cwf_f1 = current_ring_node_f1;
                         current_ring_node_f1 = current_ring_node_f1->next;
                         waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address;
                         // (2) send an event for the the CWF1 task for transmission (and snapshot extraction if needed)
                         status = rtems_event_send( Task_id[TASKID_CWF1], RTEMS_EVENT_MODE_SBM1 );
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffddd; // [1111 1101 1101 1101] f1 bits = 0
                     }
                     if ( (waveform_picker_regs->status & 0x01) == 0x01 ) { // [0001] check the f0 full bit
                         swf_f0_ready = true;
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffeee; // [1111 1110 1110 1110] f0 bits = 0
                     }
                     if ( (waveform_picker_regs->status & 0x04) == 0x04 ) { // [0100] check the f2 full bit
                         swf_f2_ready = true;
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bits = 0
                     }
                     break;
                     //*****
                     // SBM2
                     case(LFR_MODE_SBM2):
                     if ( (waveform_picker_regs->status & 0x04) == 0x04 ){ // [0100] check the f2 full bit
                         // (1) change the receiving buffer for the waveform picker
                         ring_node_to_send_cwf_f2 = current_ring_node_f2;
                         current_ring_node_f2 = current_ring_node_f2->next;
                         waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address;
                         // (2) send an event for the waveforms transmission
                         status = rtems_event_send( Task_id[TASKID_CWF2], RTEMS_EVENT_MODE_SBM2 );
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffbbb; // [1111 1011 1011 1011] f2 bit = 0
                     }
                     if ( (waveform_picker_regs->status & 0x01) == 0x01 ) { // [0001] check the f0 full bit
                         swf_f0_ready = true;
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffeee; // [1111 1110 1110 1110] f0 bits = 0
                     }
                     if ( (waveform_picker_regs->status & 0x02) == 0x02 ) { // [0010] check the f1 full bit
                         swf_f1_ready = true;
                         waveform_picker_regs->status = waveform_picker_regs->status & 0xfffffddd; // [1111 1101 1101 1101] f1, f0 bits = 0
                     }
                     break;
                     //********
                     // DEFAULT
                     default:
                     break;
                 }
             }
             //************
             // RTEMS TASKS
             rtems_task wfrm_task(rtems_task_argument argument) //used with the waveform picker VHDL IP
             {
                 /** This RTEMS task is dedicated to the transmission of snapshots of the NORMAL mode.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The following data packets are sent by this task:
                  * - TM_LFR_SCIENCE_NORMAL_SWF_F0
                  * - TM_LFR_SCIENCE_NORMAL_SWF_F1
                  * - TM_LFR_SCIENCE_NORMAL_SWF_F2
                  *
                  */
                 rtems_event_set event_out;
                 rtems_id queue_id;
                 rtems_status_code status;
                 init_header_snapshot_wf_table( SID_NORM_SWF_F0, headerSWF_F0 );
                 init_header_snapshot_wf_table( SID_NORM_SWF_F1, headerSWF_F1 );
                 init_header_snapshot_wf_table( SID_NORM_SWF_F2, headerSWF_F2 );
                 status =  get_message_queue_id_send( &queue_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in WFRM *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in WFRM ***\n")
                 while(1){
                     // wait for an RTEMS_EVENT
                     rtems_event_receive(RTEMS_EVENT_MODE_NORMAL | RTEMS_EVENT_MODE_SBM1
                                         | RTEMS_EVENT_MODE_SBM2 | RTEMS_EVENT_MODE_SBM2_WFRM,
                                         RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);
                     if (event_out == RTEMS_EVENT_MODE_NORMAL)
                     {
                         DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_NORMAL\n")
                         send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);
                         send_waveform_SWF((volatile int*) ring_node_to_send_swf_f1->buffer_address, SID_NORM_SWF_F1, headerSWF_F1, queue_id);
                         send_waveform_SWF((volatile int*) ring_node_to_send_swf_f2->buffer_address, SID_NORM_SWF_F2, headerSWF_F2, queue_id);
                     }
                     if (event_out == RTEMS_EVENT_MODE_SBM1)
                     {
                         DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_SBM1\n")
                         send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);
                         send_waveform_SWF((volatile int*) wf_snap_extracted                       , SID_NORM_SWF_F1, headerSWF_F1, queue_id);
                         send_waveform_SWF((volatile int*) ring_node_to_send_swf_f2->buffer_address, SID_NORM_SWF_F2, headerSWF_F2, queue_id);
                     }
                     if (event_out == RTEMS_EVENT_MODE_SBM2)
                     {
                         DEBUG_PRINTF("WFRM received RTEMS_EVENT_MODE_SBM2\n")
                         send_waveform_SWF((volatile int*) ring_node_to_send_swf_f0->buffer_address, SID_NORM_SWF_F0, headerSWF_F0, queue_id);
                         send_waveform_SWF((volatile int*) ring_node_to_send_swf_f1->buffer_address, SID_NORM_SWF_F1, headerSWF_F1, queue_id);
                         send_waveform_SWF((volatile int*) wf_snap_extracted                       , SID_NORM_SWF_F2, headerSWF_F2, queue_id);
                     }
                 }
             }
             rtems_task cwf3_task(rtems_task_argument argument) //used with the waveform picker VHDL IP
             {
                 /** This RTEMS task is dedicated to the transmission of continuous waveforms at f3.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The following data packet is sent by this task:
                  * - TM_LFR_SCIENCE_NORMAL_CWF_F3
                  *
                  */
                 rtems_event_set event_out;
                 rtems_id queue_id;
                 rtems_status_code status;
                 init_header_continuous_wf_table( SID_NORM_CWF_LONG_F3, headerCWF_F3 );
                 init_header_continuous_cwf3_light_table( headerCWF_F3_light );
                 status =  get_message_queue_id_send( &queue_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in CWF3 *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in CWF3 ***\n")
                 while(1){
                     // wait for an RTEMS_EVENT
                     rtems_event_receive( RTEMS_EVENT_0,
                                         RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);
                     if ( (lfrCurrentMode == LFR_MODE_NORMAL)
                          || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode==LFR_MODE_SBM2) )
                     {
                         if ( (parameter_dump_packet.sy_lfr_n_cwf_long_f3 & 0x01) == 0x01)
                         {
                             PRINTF("send CWF_LONG_F3\n")
                             send_waveform_CWF(
                                         (volatile int*) ring_node_to_send_cwf_f3->buffer_address,
                                         SID_NORM_CWF_LONG_F3, headerCWF_F3, queue_id );
                         }
                         else
                         {
                             PRINTF("send CWF_F3 (light)\n")
                             send_waveform_CWF3_light(
                                         (volatile int*) ring_node_to_send_cwf_f3->buffer_address,
                                         headerCWF_F3_light, queue_id );
                         }
                     }
                     else
                     {
                         PRINTF1("in CWF3 *** lfrCurrentMode is %d, no data will be sent\n", lfrCurrentMode)
                     }
                 }
             }
             rtems_task cwf2_task(rtems_task_argument argument)  // ONLY USED IN BURST AND SBM2
             {
                 /** This RTEMS task is dedicated to the transmission of continuous waveforms at f2.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The following data packet is sent by this function:
                  * - TM_LFR_SCIENCE_BURST_CWF_F2
                  * - TM_LFR_SCIENCE_SBM2_CWF_F2
                  *
                  */
                 rtems_event_set event_out;
                 rtems_id queue_id;
                 rtems_status_code status;
                 init_header_continuous_wf_table( SID_BURST_CWF_F2, headerCWF_F2_BURST );
                 init_header_continuous_wf_table( SID_SBM2_CWF_F2, headerCWF_F2_SBM2 );
                 status =  get_message_queue_id_send( &queue_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in CWF2 *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in CWF2 ***\n")
                 while(1){
                     // wait for an RTEMS_EVENT
                     rtems_event_receive( RTEMS_EVENT_MODE_BURST | RTEMS_EVENT_MODE_SBM2,
                                         RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);
                     if (event_out == RTEMS_EVENT_MODE_BURST)
                     {
                         send_waveform_CWF( (volatile int *) ring_node_to_send_cwf_f2->buffer_address, SID_BURST_CWF_F2, headerCWF_F2_BURST, queue_id );
                     }
                     if (event_out == RTEMS_EVENT_MODE_SBM2)
                     {
                         send_waveform_CWF( (volatile int *) ring_node_to_send_cwf_f2->buffer_address, SID_SBM2_CWF_F2, headerCWF_F2_SBM2, queue_id );
                         // launch snapshot extraction if needed
                         if (extractSWF == true)
                         {
                             ring_node_to_send_swf_f2 = ring_node_to_send_cwf_f2;
                             // extract the snapshot
                             build_snapshot_from_ring( ring_node_to_send_swf_f2, 2 );
                             // send the snapshot when built
                             status = rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_SBM2 );
                             extractSWF = false;
                         }
                         if (swf_f0_ready && swf_f1_ready)
                         {
                             extractSWF = true;
                             swf_f0_ready = false;
                             swf_f1_ready = false;
                         }
                     }
                 }
             }
             rtems_task cwf1_task(rtems_task_argument argument)  // ONLY USED IN SBM1
             {
                 /** This RTEMS task is dedicated to the transmission of continuous waveforms at f1.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  * The following data packet is sent by this function:
                  * - TM_LFR_SCIENCE_SBM1_CWF_F1
                  *
                  */
                 rtems_event_set event_out;
                 rtems_id queue_id;
                 rtems_status_code status;
                 init_header_continuous_wf_table( SID_SBM1_CWF_F1, headerCWF_F1 );
                 status =  get_message_queue_id_send( &queue_id );
                 if (status != RTEMS_SUCCESSFUL)
                 {
                     PRINTF1("in CWF1 *** ERR get_message_queue_id_send %d\n", status)
                 }
                 BOOT_PRINTF("in CWF1 ***\n")
                 while(1){
                     // wait for an RTEMS_EVENT
                     rtems_event_receive( RTEMS_EVENT_MODE_SBM1,
                                         RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);
                     send_waveform_CWF( (volatile int*) ring_node_to_send_cwf_f1->buffer_address, SID_SBM1_CWF_F1, headerCWF_F1, queue_id );
                     // launch snapshot extraction if needed
                     if (extractSWF == true)
                     {
                         ring_node_to_send_swf_f1 = ring_node_to_send_cwf_f1;
                         // launch the snapshot extraction
                         status = rtems_event_send( Task_id[TASKID_SWBD], RTEMS_EVENT_MODE_SBM1 );
                         extractSWF = false;
                     }
                     if (swf_f0_ready == true)
                     {
                         extractSWF = true;
                         swf_f0_ready = false;   // this step shall be executed only one time
                     }
                     if ((swf_f1_ready == true) && (swf_f2_ready == true))   // swf_f1 is ready after the extraction
                     {
                         status = rtems_event_send( Task_id[TASKID_WFRM], RTEMS_EVENT_MODE_SBM1 );
                         swf_f1_ready = false;
                         swf_f2_ready = false;
                     }
                 }
             }
             rtems_task swbd_task(rtems_task_argument argument)
             {
                 /** This RTEMS task is dedicated to the building of snapshots from different continuous waveforms buffers.
                  *
                  * @param unused is the starting argument of the RTEMS task
                  *
                  */
                 rtems_event_set event_out;
                 BOOT_PRINTF("in SWBD ***\n")
                 while(1){
                     // wait for an RTEMS_EVENT
                     rtems_event_receive( RTEMS_EVENT_MODE_SBM1 | RTEMS_EVENT_MODE_SBM2,
                                         RTEMS_WAIT | RTEMS_EVENT_ANY, RTEMS_NO_TIMEOUT, &event_out);
                     if (event_out == RTEMS_EVENT_MODE_SBM1)
                     {
                         build_snapshot_from_ring( ring_node_to_send_swf_f1, 1 );
                         swf_f1_ready = true;    // the snapshot has been extracted and is ready to be sent
                     }
                     else
                     {
                         PRINTF1("in SWBD *** unexpected rtems event received %x\n", (int) event_out)
                     }
                 }
             }
             //******************
             // general functions
             void WFP_init_rings( void )
             {
                 // F0 RING
                 init_waveform_ring( waveform_ring_f0, NB_RING_NODES_F0, wf_snap_f0 );
                 // F1 RING
                 init_waveform_ring( waveform_ring_f1, NB_RING_NODES_F1, wf_snap_f1 );
                 // F2 RING
                 init_waveform_ring( waveform_ring_f2, NB_RING_NODES_F2, wf_snap_f2 );
                 // F3 RING
                 init_waveform_ring( waveform_ring_f3, NB_RING_NODES_F3, wf_cont_f3 );
                 DEBUG_PRINTF1("waveform_ring_f0 @%x\n", (unsigned int) waveform_ring_f0)
                 DEBUG_PRINTF1("waveform_ring_f1 @%x\n", (unsigned int) waveform_ring_f1)
                 DEBUG_PRINTF1("waveform_ring_f2 @%x\n", (unsigned int) waveform_ring_f2)
                 DEBUG_PRINTF1("waveform_ring_f3 @%x\n", (unsigned int) waveform_ring_f3)
             }
             void init_waveform_ring(ring_node waveform_ring[], unsigned char nbNodes, volatile int wfrm[] )
             {
                 unsigned char i;
                 waveform_ring[0].next            = (ring_node*) &waveform_ring[ 1 ];
                 waveform_ring[0].previous        = (ring_node*) &waveform_ring[ nbNodes - 1 ];
                 waveform_ring[0].buffer_address  = (int) &wfrm[0];
                 waveform_ring[nbNodes-1].next           = (ring_node*) &waveform_ring[ 0 ];
                 waveform_ring[nbNodes-1].previous       = (ring_node*) &waveform_ring[ nbNodes - 2 ];
                 waveform_ring[nbNodes-1].buffer_address = (int) &wfrm[ (nbNodes-1) * WFRM_BUFFER ];
                 for(i=1; i<nbNodes-1; i++)
                 {
                     waveform_ring[i].next            = (ring_node*) &waveform_ring[ i + 1 ];
                     waveform_ring[i].previous        = (ring_node*) &waveform_ring[ i - 1 ];
                     waveform_ring[i].buffer_address  = (int) &wfrm[ i * WFRM_BUFFER ];
                 }
             }
             void WFP_reset_current_ring_nodes( void )
             {
                 current_ring_node_f0        = waveform_ring_f0;
                 ring_node_to_send_swf_f0    = waveform_ring_f0;
                 current_ring_node_f1        = waveform_ring_f1;
                 ring_node_to_send_cwf_f1    = waveform_ring_f1;
                 ring_node_to_send_swf_f1    = waveform_ring_f1;
                 current_ring_node_f2        = waveform_ring_f2;
                 ring_node_to_send_cwf_f2    = waveform_ring_f2;
                 ring_node_to_send_swf_f2    = waveform_ring_f2;
                 current_ring_node_f3        = waveform_ring_f3;
                 ring_node_to_send_cwf_f3    = waveform_ring_f3;
             }
             int init_header_snapshot_wf_table( unsigned int sid, Header_TM_LFR_SCIENCE_SWF_t *headerSWF)
             {
                 unsigned char i;
                 for (i=0; i<7; i++)
                 {
                     headerSWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;
                     headerSWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;
                     headerSWF[ i ].reserved = DEFAULT_RESERVED;
                     headerSWF[ i ].userApplication = CCSDS_USER_APP;
                     headerSWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);
                     headerSWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                     headerSWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                     if (i == 6)
                     {
                         headerSWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_224 >> 8);
                         headerSWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_224     );
                         headerSWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_224 >> 8);
                         headerSWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_224     );
                     }
                     else
                     {
                         headerSWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_SWF_304 >> 8);
                         headerSWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_SWF_304     );
                         headerSWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_304 >> 8);
                         headerSWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_304     );
                     }
                     headerSWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                     headerSWF[ i ].pktCnt = DEFAULT_PKTCNT;  // PKT_CNT
                     headerSWF[ i ].pktNr = i+1;    // PKT_NR
                     // DATA FIELD HEADER
                     headerSWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                     headerSWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type
                     headerSWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype
                     headerSWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;
                     // AUXILIARY DATA HEADER
                     headerSWF[ i ].time[0] = 0x00;
                     headerSWF[ i ].time[0] = 0x00;
                     headerSWF[ i ].time[0] = 0x00;
                     headerSWF[ i ].time[0] = 0x00;
                     headerSWF[ i ].time[0] = 0x00;
                     headerSWF[ i ].time[0] = 0x00;
                     headerSWF[ i ].sid = sid;
                     headerSWF[ i ].hkBIA = DEFAULT_HKBIA;
                 }
                 return LFR_SUCCESSFUL;
             }
             int init_header_continuous_wf_table( unsigned int sid, Header_TM_LFR_SCIENCE_CWF_t *headerCWF )
             {
                 unsigned int i;
                 for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF; i++)
                 {
                     headerCWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;
                     headerCWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;
                     headerCWF[ i ].reserved = DEFAULT_RESERVED;
                     headerCWF[ i ].userApplication = CCSDS_USER_APP;
                     if ( (sid == SID_SBM1_CWF_F1) || (sid == SID_SBM2_CWF_F2) )
                     {
                         headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2 >> 8);
                         headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_SBM1_SBM2);
                     }
                     else
                     {
                         headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);
                         headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                     }
                     headerCWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                     headerCWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_336 >> 8);
                     headerCWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_336     );
                     headerCWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_CWF >> 8);
                     headerCWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_CWF     );
                     headerCWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                     // DATA FIELD HEADER
                     headerCWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                     headerCWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type
                     headerCWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype
                     headerCWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;
                     // AUXILIARY DATA HEADER
                     headerCWF[ i ].sid = sid;
                     headerCWF[ i ].hkBIA = DEFAULT_HKBIA;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                 }
                 return LFR_SUCCESSFUL;
             }
             int init_header_continuous_cwf3_light_table( Header_TM_LFR_SCIENCE_CWF_t *headerCWF )
             {
                 unsigned int i;
                 for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF_LIGHT; i++)
                 {
                     headerCWF[ i ].targetLogicalAddress = CCSDS_DESTINATION_ID;
                     headerCWF[ i ].protocolIdentifier = CCSDS_PROTOCOLE_ID;
                     headerCWF[ i ].reserved = DEFAULT_RESERVED;
                     headerCWF[ i ].userApplication = CCSDS_USER_APP;
                     headerCWF[ i ].packetID[0] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST >> 8);
                     headerCWF[ i ].packetID[1] = (unsigned char) (APID_TM_SCIENCE_NORMAL_BURST);
                     headerCWF[ i ].packetSequenceControl[0] = TM_PACKET_SEQ_CTRL_STANDALONE;
                     headerCWF[ i ].packetLength[0] = (unsigned char) (TM_LEN_SCI_CWF_672 >> 8);
                     headerCWF[ i ].packetLength[1] = (unsigned char) (TM_LEN_SCI_CWF_672     );
                     headerCWF[ i ].blkNr[0] = (unsigned char) (BLK_NR_CWF_SHORT_F3 >> 8);
                     headerCWF[ i ].blkNr[1] = (unsigned char) (BLK_NR_CWF_SHORT_F3     );
                     headerCWF[ i ].packetSequenceControl[1] = TM_PACKET_SEQ_CNT_DEFAULT;
                     // DATA FIELD HEADER
                     headerCWF[ i ].spare1_pusVersion_spare2 = DEFAULT_SPARE1_PUSVERSION_SPARE2;
                     headerCWF[ i ].serviceType = TM_TYPE_LFR_SCIENCE; // service type
                     headerCWF[ i ].serviceSubType = TM_SUBTYPE_LFR_SCIENCE; // service subtype
                     headerCWF[ i ].destinationID = TM_DESTINATION_ID_GROUND;
                     // AUXILIARY DATA HEADER
                     headerCWF[ i ].sid = SID_NORM_CWF_F3;
                     headerCWF[ i ].hkBIA = DEFAULT_HKBIA;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                     headerCWF[ i ].time[0] = 0x00;
                 }
                 return LFR_SUCCESSFUL;
             }
             int send_waveform_SWF( volatile int *waveform, unsigned int sid,
                                    Header_TM_LFR_SCIENCE_SWF_t *headerSWF, rtems_id queue_id )
             {
                 /** This function sends SWF CCSDS packets (F2, F1 or F0).
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param sid is the source identifier of the data that will be sent.
                  * @param headerSWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_SWF;
                 spw_ioctl_send_SWF.hlen = TM_HEADER_LEN + 4 + 12; // + 4 is for the protocole extra header, + 12 is for the auxiliary header
                 spw_ioctl_send_SWF.options = 0;
                 ret = LFR_DEFAULT;
                 coarseTime = waveform[0];
                 fineTime   = waveform[1];
                 for (i=0; i<7; i++) // send waveform
                 {
                     spw_ioctl_send_SWF.data = (char*) &waveform[ (i * BLK_NR_304 * NB_WORDS_SWF_BLK) + TIME_OFFSET];
                     spw_ioctl_send_SWF.hdr = (char*) &headerSWF[ i ];
                     // BUILD THE DATA
                     if (i==6) {
                         spw_ioctl_send_SWF.dlen = BLK_NR_224 * NB_BYTES_SWF_BLK;
                     }
                     else {
                         spw_ioctl_send_SWF.dlen = BLK_NR_304 * NB_BYTES_SWF_BLK;
                     }
                     // SET PACKET SEQUENCE COUNTER
                     increment_seq_counter_source_id( headerSWF[ i ].packetSequenceControl, sid );
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, sid, i, headerSWF[ i ].acquisitionTime );
                     //
                     headerSWF[ i ].time[0] = headerSWF[ i ].acquisitionTime[0];
                     headerSWF[ i ].time[1] = headerSWF[ i ].acquisitionTime[1];
                     headerSWF[ i ].time[2] = headerSWF[ i ].acquisitionTime[2];
                     headerSWF[ i ].time[3] = headerSWF[ i ].acquisitionTime[3];
                     headerSWF[ i ].time[4] = headerSWF[ i ].acquisitionTime[4];
                     headerSWF[ i ].time[5] = headerSWF[ i ].acquisitionTime[5];
                     // SEND PACKET
                     status =  rtems_message_queue_send( queue_id, &spw_ioctl_send_SWF, ACTION_MSG_SPW_IOCTL_SEND_SIZE);
                     if (status != RTEMS_SUCCESSFUL) {
                         printf("%d-%d, ERR %d\n", sid, i, (int) status);
                         ret = LFR_DEFAULT;
                     }
                     rtems_task_wake_after(TIME_BETWEEN_TWO_SWF_PACKETS);  // 300 ms between each packet => 7 * 3 = 21 packets => 6.3 seconds
                 }
                 return ret;
             }
             int send_waveform_CWF(volatile int *waveform, unsigned int sid,
                                   Header_TM_LFR_SCIENCE_CWF_t *headerCWF, rtems_id queue_id)
             {
                 /** This function sends CWF CCSDS packets (F2, F1 or F0).
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param sid is the source identifier of the data that will be sent.
                  * @param headerCWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * One group of 2048 samples is sent as 7 consecutive packets, 6 packets containing 340 blocks and 8 packets containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_CWF;
                 spw_ioctl_send_CWF.hlen = TM_HEADER_LEN + 4 + 10; // + 4 is for the protocole extra header, + 10 is for the auxiliary header
                 spw_ioctl_send_CWF.options = 0;
                 ret = LFR_DEFAULT;
                 coarseTime = waveform[0];
                 fineTime   = waveform[1];
                 for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF; i++) // send waveform
                 {
                     spw_ioctl_send_CWF.data = (char*) &waveform[ (i * BLK_NR_CWF * NB_WORDS_SWF_BLK) + TIME_OFFSET];
                     spw_ioctl_send_CWF.hdr = (char*) &headerCWF[ i ];
                     // BUILD THE DATA
                     spw_ioctl_send_CWF.dlen = BLK_NR_CWF * NB_BYTES_SWF_BLK;
                     // SET PACKET SEQUENCE COUNTER
                     increment_seq_counter_source_id( headerCWF[ i ].packetSequenceControl, sid );
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, sid, i, headerCWF[ i ].acquisitionTime);
                     //
                     headerCWF[ i ].time[0] = headerCWF[ i ].acquisitionTime[0];
                     headerCWF[ i ].time[1] = headerCWF[ i ].acquisitionTime[1];
                     headerCWF[ i ].time[2] = headerCWF[ i ].acquisitionTime[2];
                     headerCWF[ i ].time[3] = headerCWF[ i ].acquisitionTime[3];
                     headerCWF[ i ].time[4] = headerCWF[ i ].acquisitionTime[4];
                     headerCWF[ i ].time[5] = headerCWF[ i ].acquisitionTime[5];
                     // SEND PACKET
                     if (sid == SID_NORM_CWF_LONG_F3)
                     {
                         status =  rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));
                         if (status != RTEMS_SUCCESSFUL) {
                             printf("%d-%d, ERR %d\n", sid, i, (int) status);
                             ret = LFR_DEFAULT;
                         }
                         rtems_task_wake_after(TIME_BETWEEN_TWO_CWF3_PACKETS);
                     }
                     else
                     {
                         status =  rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));
                         if (status != RTEMS_SUCCESSFUL) {
                             printf("%d-%d, ERR %d\n", sid, i, (int) status);
                             ret = LFR_DEFAULT;
                         }
                     }
                 }
                 return ret;
             }
             int send_waveform_CWF3_light(volatile int *waveform, Header_TM_LFR_SCIENCE_CWF_t *headerCWF, rtems_id queue_id)
             {
                 /** This function sends CWF_F3 CCSDS packets without the b1, b2 and b3 data.
                  *
                  * @param waveform points to the buffer containing the data that will be send.
                  * @param headerCWF points to a table of headers that have been prepared for the data transmission.
                  * @param queue_id is the id of the rtems queue to which spw_ioctl_pkt_send structures will be send. The structures
                  * contain information to setup the transmission of the data packets.
                  *
                  * By default, CWF_F3 packet are send without the b1, b2 and b3 data. This function rebuilds a data buffer
                  * from the incoming data and sends it in 7 packets, 6 containing 340 blocks and 1 one containing 8 blocks.
                  *
                  */
                 unsigned int i;
                 int ret;
                 unsigned int coarseTime;
                 unsigned int fineTime;
                 rtems_status_code status;
                 spw_ioctl_pkt_send spw_ioctl_send_CWF;
                 char *sample;
                 spw_ioctl_send_CWF.hlen = TM_HEADER_LEN + 4 + 10; // + 4 is for the protocole extra header, + 10 is for the auxiliary header
                 spw_ioctl_send_CWF.options = 0;
                 ret = LFR_DEFAULT;
                 //**********************
                 // BUILD CWF3_light DATA
                 for ( i=0; i< NB_SAMPLES_PER_SNAPSHOT; i++)
                 {
                     sample = (char*) &waveform[ (i * NB_WORDS_SWF_BLK) + TIME_OFFSET ];
                     wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK)     + TIME_OFFSET_IN_BYTES ] = sample[ 0 ];
                     wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 1 + TIME_OFFSET_IN_BYTES ] = sample[ 1 ];
                     wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 2 + TIME_OFFSET_IN_BYTES ] = sample[ 2 ];
                     wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 3 + TIME_OFFSET_IN_BYTES ] = sample[ 3 ];
                     wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 4 + TIME_OFFSET_IN_BYTES ] = sample[ 4 ];
                     wf_cont_f3_light[ (i * NB_BYTES_CWF3_LIGHT_BLK) + 5 + TIME_OFFSET_IN_BYTES ] = sample[ 5 ];
                 }
                 coarseTime = waveform[0];
                 fineTime   = waveform[1];
                 //*********************
                 // SEND CWF3_light DATA
                 for (i=0; i<NB_PACKETS_PER_GROUP_OF_CWF_LIGHT; i++) // send waveform
                 {
                     spw_ioctl_send_CWF.data = (char*) &wf_cont_f3_light[ (i * BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK) + TIME_OFFSET_IN_BYTES];
                     spw_ioctl_send_CWF.hdr = (char*) &headerCWF[ i ];
                     // BUILD THE DATA
                     spw_ioctl_send_CWF.dlen = BLK_NR_CWF_SHORT_F3 * NB_BYTES_CWF3_LIGHT_BLK;
                     // SET PACKET SEQUENCE COUNTER
                     increment_seq_counter_source_id( headerCWF[ i ].packetSequenceControl, SID_NORM_CWF_F3 );
                     // SET PACKET TIME
                     compute_acquisition_time( coarseTime, fineTime, SID_NORM_CWF_F3, i, headerCWF[ i ].acquisitionTime );
                     //
                     headerCWF[ i ].time[0] = headerCWF[ i ].acquisitionTime[0];
                     headerCWF[ i ].time[1] = headerCWF[ i ].acquisitionTime[1];
                     headerCWF[ i ].time[2] = headerCWF[ i ].acquisitionTime[2];
                     headerCWF[ i ].time[3] = headerCWF[ i ].acquisitionTime[3];
                     headerCWF[ i ].time[4] = headerCWF[ i ].acquisitionTime[4];
                     headerCWF[ i ].time[5] = headerCWF[ i ].acquisitionTime[5];
                     // SEND PACKET
                     status =  rtems_message_queue_send( queue_id, &spw_ioctl_send_CWF, sizeof(spw_ioctl_send_CWF));
                     if (status != RTEMS_SUCCESSFUL) {
                         printf("%d-%d, ERR %d\n", SID_NORM_CWF_F3, i, (int) status);
                         ret = LFR_DEFAULT;
                     }
                     rtems_task_wake_after(TIME_BETWEEN_TWO_CWF3_PACKETS);
                 }
                 return ret;
             }
             void compute_acquisition_time_old( unsigned int coarseTime, unsigned int fineTime,
                                            unsigned int sid, unsigned char pa_lfr_pkt_nr, unsigned char * acquisitionTime )
             {
                 unsigned long long int acquisitionTimeAsLong;
                 unsigned char localAcquisitionTime[6];
                 double deltaT;
                 deltaT = 0.;
                 localAcquisitionTime[0] = (unsigned char) ( coarseTime >>  8 );
                 localAcquisitionTime[1] = (unsigned char) ( coarseTime       );
                 localAcquisitionTime[2] = (unsigned char) ( coarseTime >> 24 );
                 localAcquisitionTime[3] = (unsigned char) ( coarseTime >> 16 );
                 localAcquisitionTime[4] = (unsigned char) ( fineTime   >> 24 );
                 localAcquisitionTime[5] = (unsigned char) ( fineTime   >> 16 );
                 acquisitionTimeAsLong = ( (unsigned long long int) localAcquisitionTime[0] << 40 )
                         + ( (unsigned long long int) localAcquisitionTime[1] << 32 )
                         + ( localAcquisitionTime[2] << 24 )
                         + ( localAcquisitionTime[3] << 16 )
                         + ( localAcquisitionTime[4] << 8  )
                         + ( localAcquisitionTime[5]       );
                 switch( sid )
                 {
                 case SID_NORM_SWF_F0:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 24576. ;
                     break;
                 case SID_NORM_SWF_F1:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 4096. ;
                     break;
                 case SID_NORM_SWF_F2:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 256. ;
                     break;
                 case SID_SBM1_CWF_F1:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 4096. ;
                     break;
                 case SID_SBM2_CWF_F2:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;
                     break;
                 case SID_BURST_CWF_F2:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;
                     break;
                 case SID_NORM_CWF_F3:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF_SHORT_F3 * 65536. / 16. ;
                     break;
                 case SID_NORM_CWF_LONG_F3:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 16. ;
                     break;
                 default:
                     PRINTF1("in compute_acquisition_time *** ERR unexpected sid %d", sid)
                     deltaT = 0.;
                     break;
                 }
                 acquisitionTimeAsLong = acquisitionTimeAsLong + (unsigned long long int) deltaT;
                 //
                 acquisitionTime[0] = (unsigned char) (acquisitionTimeAsLong >> 40);
                 acquisitionTime[1] = (unsigned char) (acquisitionTimeAsLong >> 32);
                 acquisitionTime[2] = (unsigned char) (acquisitionTimeAsLong >> 24);
                 acquisitionTime[3] = (unsigned char) (acquisitionTimeAsLong >> 16);
                 acquisitionTime[4] = (unsigned char) (acquisitionTimeAsLong >> 8 );
                 acquisitionTime[5] = (unsigned char) (acquisitionTimeAsLong      );
             }
             void compute_acquisition_time( unsigned int coarseTime, unsigned int fineTime,
                                            unsigned int sid, unsigned char pa_lfr_pkt_nr, unsigned char * acquisitionTime )
             {
                 unsigned long long int acquisitionTimeAsLong;
                 unsigned char localAcquisitionTime[6];
                 double deltaT;
                 deltaT = 0.;
                 localAcquisitionTime[0] = (unsigned char) ( coarseTime >> 24 );
                 localAcquisitionTime[1] = (unsigned char) ( coarseTime >> 16 );
                 localAcquisitionTime[2] = (unsigned char) ( coarseTime >> 8  );
                 localAcquisitionTime[3] = (unsigned char) ( coarseTime       );
                 localAcquisitionTime[4] = (unsigned char) ( fineTime   >> 8  );
                 localAcquisitionTime[5] = (unsigned char) ( fineTime         );
                 acquisitionTimeAsLong = ( (unsigned long long int) localAcquisitionTime[0] << 40 )
                         + ( (unsigned long long int) localAcquisitionTime[1] << 32 )
                         + ( localAcquisitionTime[2] << 24 )
                         + ( localAcquisitionTime[3] << 16 )
                         + ( localAcquisitionTime[4] << 8  )
                         + ( localAcquisitionTime[5]       );
                 switch( sid )
                 {
                 case SID_NORM_SWF_F0:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 24576. ;
                     break;
                 case SID_NORM_SWF_F1:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 4096. ;
                     break;
                 case SID_NORM_SWF_F2:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_304 * 65536. / 256. ;
                     break;
                 case SID_SBM1_CWF_F1:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 4096. ;
                     break;
                 case SID_SBM2_CWF_F2:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;
                     break;
                 case SID_BURST_CWF_F2:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 256. ;
                     break;
                 case SID_NORM_CWF_F3:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF_SHORT_F3 * 65536. / 16. ;
                     break;
                 case SID_NORM_CWF_LONG_F3:
                     deltaT = ( (double ) (pa_lfr_pkt_nr) ) * BLK_NR_CWF * 65536. / 16. ;
                     break;
                 default:
                     PRINTF1("in compute_acquisition_time *** ERR unexpected sid %d", sid)
                     deltaT = 0.;
                     break;
                 }
                 acquisitionTimeAsLong = acquisitionTimeAsLong + (unsigned long long int) deltaT;
                 //
                 acquisitionTime[0] = (unsigned char) (acquisitionTimeAsLong >> 40);
                 acquisitionTime[1] = (unsigned char) (acquisitionTimeAsLong >> 32);
                 acquisitionTime[2] = (unsigned char) (acquisitionTimeAsLong >> 24);
                 acquisitionTime[3] = (unsigned char) (acquisitionTimeAsLong >> 16);
                 acquisitionTime[4] = (unsigned char) (acquisitionTimeAsLong >> 8 );
                 acquisitionTime[5] = (unsigned char) (acquisitionTimeAsLong      );
             }
             void build_snapshot_from_ring( ring_node *ring_node_to_send, unsigned char frequencyChannel )
             {
                 unsigned int i;
                 unsigned long long int centerTime_asLong;
                 unsigned long long int acquisitionTimeF0_asLong;
                 unsigned long long int acquisitionTime_asLong;
                 unsigned long long int bufferAcquisitionTime_asLong;
                 unsigned char *ptr1;
                 unsigned char *ptr2;
                 unsigned char *timeCharPtr;
                 unsigned char nb_ring_nodes;
                 unsigned long long int frequency_asLong;
                 unsigned long long int nbTicksPerSample_asLong;
                 unsigned long long int nbSamplesPart1_asLong;
                 unsigned long long int sampleOffset_asLong;
                 unsigned int deltaT_F0;
                 unsigned int deltaT_F1;
                 unsigned long long int deltaT_F2;
                 deltaT_F0 = 2731;      // (2048. / 24576. / 2.) * 65536. = 2730.667;
                 deltaT_F1 = 16384;  // (2048. / 4096.  / 2.) * 65536. = 16384;
                 deltaT_F2 = 262144; // (2048. / 256.   / 2.) * 65536. = 262144;
                 sampleOffset_asLong = 0x00;
                 // (1) get the f0 acquisition time
                 build_acquisition_time( &acquisitionTimeF0_asLong, current_ring_node_f0 );
                 // (2) compute the central reference time
                 centerTime_asLong = acquisitionTimeF0_asLong + deltaT_F0;
                 // (3) compute the acquisition time of the current snapshot
                 switch(frequencyChannel)
                 {
                 case 1: // 1 is for F1 = 4096 Hz
                     acquisitionTime_asLong = centerTime_asLong - deltaT_F1;
                     nb_ring_nodes = NB_RING_NODES_F1;
                     frequency_asLong = 4096;
                     nbTicksPerSample_asLong = 16;  // 65536 / 4096;
                     break;
                 case 2: // 2 is for F2 = 256 Hz
                     acquisitionTime_asLong = centerTime_asLong - deltaT_F2;
                     nb_ring_nodes = NB_RING_NODES_F2;
                     frequency_asLong = 256;
                     nbTicksPerSample_asLong = 256;  // 65536 / 256;
                     break;
                 default:
                     acquisitionTime_asLong = centerTime_asLong;
                     frequency_asLong = 256;
                     nbTicksPerSample_asLong = 256;
                     break;
                 }
                 //****************************************************************************
                 // (4) search the ring_node with the acquisition time <= acquisitionTime_asLong
                 for (i=0; i<nb_ring_nodes; i++)
                 {
                     PRINTF1("%d ... ", i)
                     build_acquisition_time( &bufferAcquisitionTime_asLong, ring_node_to_send );
                     if (bufferAcquisitionTime_asLong <= acquisitionTime_asLong)
                     {
                         PRINTF1("buffer found with acquisition time = %llx\n", bufferAcquisitionTime_asLong)
                         break;
                     }
                     ring_node_to_send = ring_node_to_send->previous;
                 }
                 // (5) compute the number of samples to take in the current buffer
                 sampleOffset_asLong = ((acquisitionTime_asLong - bufferAcquisitionTime_asLong) * frequency_asLong ) >> 16;
                 nbSamplesPart1_asLong = NB_SAMPLES_PER_SNAPSHOT - sampleOffset_asLong;
                 PRINTF2("sampleOffset_asLong = %llx, nbSamplesPart1_asLong = %llx\n", sampleOffset_asLong, nbSamplesPart1_asLong)
                 // (6) compute the final acquisition time
                 acquisitionTime_asLong = bufferAcquisitionTime_asLong +
                         sampleOffset_asLong * nbTicksPerSample_asLong;
                 // (7) copy the acquisition time at the beginning of the extrated snapshot
                 ptr1 = (unsigned char*) &acquisitionTime_asLong;
                 ptr2 = (unsigned char*) wf_snap_extracted;
                 ptr2[0] = ptr1[ 0 + 2 ];
                 ptr2[1] = ptr1[ 1 + 2 ];
                 ptr2[2] = ptr1[ 2 + 2 ];
                 ptr2[3] = ptr1[ 3 + 2 ];
                 ptr2[6] = ptr1[ 4 + 2 ];
                 ptr2[7] = ptr1[ 5 + 2 ];
                 // re set the synchronization bit
                 timeCharPtr = (unsigned char*) ring_node_to_send->buffer_address;
                 ptr2[0] = ptr2[0] | (timeCharPtr[0] & 0x80); // [1000 0000]
                 if ( (nbSamplesPart1_asLong >= NB_SAMPLES_PER_SNAPSHOT) | (nbSamplesPart1_asLong < 0) )
                 {
                     nbSamplesPart1_asLong = 0;
                 }
                 // copy the part 1 of the snapshot in the extracted buffer
                 for ( i = 0; i < (nbSamplesPart1_asLong * NB_WORDS_SWF_BLK); i++ )
                 {
                     wf_snap_extracted[i + TIME_OFFSET] =
                             ((int*) ring_node_to_send->buffer_address)[i + (sampleOffset_asLong * NB_WORDS_SWF_BLK) + TIME_OFFSET];
                 }
                 // copy the part 2 of the snapshot in the extracted buffer
                 ring_node_to_send = ring_node_to_send->next;
                 for ( i = (nbSamplesPart1_asLong * NB_WORDS_SWF_BLK); i < (NB_SAMPLES_PER_SNAPSHOT * NB_WORDS_SWF_BLK); i++ )
                 {
                     wf_snap_extracted[i + TIME_OFFSET] =
                             ((int*) ring_node_to_send->buffer_address)[(i-(nbSamplesPart1_asLong * NB_WORDS_SWF_BLK)) + TIME_OFFSET];
                 }
             }
             void build_acquisition_time_old( unsigned long long int *acquisitionTimeAslong, ring_node *current_ring_node )
             {
                 unsigned char *acquisitionTimeCharPtr;
                 acquisitionTimeCharPtr = (unsigned char*) current_ring_node->buffer_address;
                 *acquisitionTimeAslong = 0x00;
                 *acquisitionTimeAslong = ( acquisitionTimeCharPtr[0] << 24 )
                         + ( acquisitionTimeCharPtr[1] << 16 )
                         + ( (unsigned long long int) (acquisitionTimeCharPtr[2] & 0x7f) << 40 ) // [0111 1111] mask the synchronization bit
                         + ( (unsigned long long int) acquisitionTimeCharPtr[3] << 32 )
                         + ( acquisitionTimeCharPtr[4] << 8  )
                         + ( acquisitionTimeCharPtr[5]       );
             }
             void build_acquisition_time( unsigned long long int *acquisitionTimeAslong, ring_node *current_ring_node )
             {
                 unsigned char *acquisitionTimeCharPtr;
                 acquisitionTimeCharPtr = (unsigned char*) current_ring_node->buffer_address;
                 *acquisitionTimeAslong = 0x00;
                 *acquisitionTimeAslong = ( (unsigned long long int) (acquisitionTimeCharPtr[0] & 0x7f) << 40 ) // [0111 1111] mask the synchronization bit
                         + ( (unsigned long long int) acquisitionTimeCharPtr[1] << 32 )
                         + ( acquisitionTimeCharPtr[2] << 24 )
                         + ( acquisitionTimeCharPtr[3] << 16 )
                         + ( acquisitionTimeCharPtr[6] << 8  )
                         + ( acquisitionTimeCharPtr[7]       );
             }
             //**************
             // wfp registers
             void reset_wfp_burst_enable(void)
             {
                 /** This function resets the waveform picker burst_enable register.
                  *
                  * The burst bits [f2 f1 f0] and the enable bits [f3 f2 f1 f0] are set to 0.
                  *
                  */
                 waveform_picker_regs->run_burst_enable = 0x00;              // burst f2, f1, f0     enable f3, f2, f1, f0
             }
             void reset_wfp_status( void )
             {
                 /** This function resets the waveform picker status register.
                  *
                  * All status bits are set to 0 [new_err full_err full].
                  *
                  */
                 waveform_picker_regs->status = 0x00;              // burst f2, f1, f0     enable f3, f2, f1, f0
             }
             void reset_waveform_picker_regs(void)
             {
                 /** This function resets the waveform picker module registers.
                 *
                 * The registers affected by this function are located at the following offset addresses:
                 * - 0x00 data_shaping
                 * - 0x04 run_burst_enable
                 * - 0x08 addr_data_f0
                 * - 0x0C addr_data_f1
                 * - 0x10 addr_data_f2
                 * - 0x14 addr_data_f3
                 * - 0x18 status
                 * - 0x1C delta_snapshot
                 * - 0x20 delta_f0
                 * - 0x24 delta_f0_2
                 * - 0x28 delta_f1
                 * - 0x2c delta_f2
                 * - 0x30 nb_data_by_buffer
                 * - 0x34 nb_snapshot_param
                 * - 0x38 start_date
                 * - 0x3c nb_word_in_buffer
                 *
                 */
                 set_wfp_data_shaping();                                     // 0x00 *** R1 R0 SP1 SP0 BW
                 reset_wfp_burst_enable();                                   // 0x04 *** [run *** burst f2, f1, f0 *** enable f3, f2, f1, f0 ]
                 waveform_picker_regs->addr_data_f0 = current_ring_node_f0->buffer_address; // 0x08
                 waveform_picker_regs->addr_data_f1 = current_ring_node_f1->buffer_address; // 0x0c
                 waveform_picker_regs->addr_data_f2 = current_ring_node_f2->buffer_address; // 0x10
                 waveform_picker_regs->addr_data_f3 = current_ring_node_f3->buffer_address; // 0x14
                 reset_wfp_status();                                         // 0x18
                 //
                 set_wfp_delta_snapshot();   // 0x1c
                 set_wfp_delta_f0_f0_2();    // 0x20, 0x24
                 set_wfp_delta_f1();         // 0x28
                 set_wfp_delta_f2();         // 0x2c
                 DEBUG_PRINTF1("delta_snapshot %x\n", waveform_picker_regs->delta_snapshot)
                 DEBUG_PRINTF1("delta_f0 %x\n", waveform_picker_regs->delta_f0)
                 DEBUG_PRINTF1("delta_f0_2 %x\n", waveform_picker_regs->delta_f0_2)
                 DEBUG_PRINTF1("delta_f1 %x\n", waveform_picker_regs->delta_f1)
                 DEBUG_PRINTF1("delta_f2 %x\n", waveform_picker_regs->delta_f2)
                 // 2688 = 8 * 336
                 waveform_picker_regs->nb_data_by_buffer = 0xa7f;    // 0x30 *** 2688 - 1 => nb samples -1
                 waveform_picker_regs->snapshot_param = 0xa80;       // 0x34 *** 2688 => nb samples
                 waveform_picker_regs->start_date = 0x00;            // 0x38
                 waveform_picker_regs->nb_word_in_buffer = 0x1f82;   // 0x3c *** 2688 * 3 + 2 = 8066
             }
             void set_wfp_data_shaping( void )
             {
                 /** This function sets the data_shaping register of the waveform picker module.
                  *
                  * The value is read from one field of the parameter_dump_packet structure:\n
                  * bw_sp0_sp1_r0_r1
                  *
                  */
                 unsigned char data_shaping;
                 // get the parameters for the data shaping [BW SP0 SP1 R0 R1] in sy_lfr_common1 and configure the register
                 // waveform picker : [R1 R0 SP1 SP0 BW]
                 data_shaping = parameter_dump_packet.bw_sp0_sp1_r0_r1;
                 waveform_picker_regs->data_shaping =
                           ( (data_shaping & 0x10) >> 4 )     // BW
                         + ( (data_shaping & 0x08) >> 2 )     // SP0
                         + ( (data_shaping & 0x04)      )     // SP1
                         + ( (data_shaping & 0x02) << 2 )     // R0
                         + ( (data_shaping & 0x01) << 4 );    // R1
             }
             void set_wfp_burst_enable_register( unsigned char mode )
             {
                 /** This function sets the waveform picker burst_enable register depending on the mode.
                  *
                  * @param mode is the LFR mode to launch.
                  *
                  * The burst bits shall be before the enable bits.
                  *
                  */
                 // [0000 0000] burst f2, f1, f0 enable f3 f2 f1 f0
                 // the burst bits shall be set first, before the enable bits
                 switch(mode) {
                 case(LFR_MODE_NORMAL):
                     waveform_picker_regs->run_burst_enable = 0x00;  // [0000 0000] no burst enable
                     waveform_picker_regs->run_burst_enable = 0x0f; // [0000 1111] enable f3 f2 f1 f0
                     break;
                 case(LFR_MODE_BURST):
                     waveform_picker_regs->run_burst_enable = 0x40;  // [0100 0000] f2 burst enabled
             //        waveform_picker_regs->run_burst_enable =  waveform_picker_regs->run_burst_enable | 0x04; // [0100] enable f2
                     waveform_picker_regs->run_burst_enable =  waveform_picker_regs->run_burst_enable | 0x0c; // [1100] enable f3 AND f2
                     break;
                 case(LFR_MODE_SBM1):
                     waveform_picker_regs->run_burst_enable = 0x20;  // [0010 0000] f1 burst enabled
                     waveform_picker_regs->run_burst_enable =  waveform_picker_regs->run_burst_enable | 0x0f; // [1111] enable f3 f2 f1 f0
                     break;
                 case(LFR_MODE_SBM2):
                     waveform_picker_regs->run_burst_enable = 0x40;  // [0100 0000] f2 burst enabled
                     waveform_picker_regs->run_burst_enable =  waveform_picker_regs->run_burst_enable | 0x0f; // [1111] enable f3 f2 f1 f0
                     break;
                 default:
                     waveform_picker_regs->run_burst_enable = 0x00;  // [0000 0000] no burst enabled, no waveform enabled
                     break;
                 }
             }
             void set_wfp_delta_snapshot( void )
             {
                 /** This function sets the delta_snapshot register of the waveform picker module.
                  *
                  * The value is read from two (unsigned char) of the parameter_dump_packet structure:
                  * - sy_lfr_n_swf_p[0]
                  * - sy_lfr_n_swf_p[1]
                  *
                  */
                 unsigned int delta_snapshot;
                 unsigned int delta_snapshot_in_T2;
                 delta_snapshot = parameter_dump_packet.sy_lfr_n_swf_p[0]*256
                         + parameter_dump_packet.sy_lfr_n_swf_p[1];
                 delta_snapshot_in_T2 = delta_snapshot * 256;
-                waveform_picker_regs->delta_snapshot = delta_snapshot_in_T2;    // max 4 bytes
+                waveform_picker_regs->delta_snapshot = delta_snapshot_in_T2 - 1;    // max 4 bytes
             }
             void set_wfp_delta_f0_f0_2( void )
             {
                 unsigned int delta_snapshot;
                 unsigned int nb_samples_per_snapshot;
                 float delta_f0_in_float;
                 delta_snapshot = waveform_picker_regs->delta_snapshot;
                 nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];
                 delta_f0_in_float =nb_samples_per_snapshot / 2. * ( 1. / 256. - 1. / 24576.) * 256.;
                 waveform_picker_regs->delta_f0      =  delta_snapshot - floor( delta_f0_in_float );
                 waveform_picker_regs->delta_f0_2    = 0x7;         // max 7 bits
             }
             void set_wfp_delta_f1( void )
             {
                 unsigned int delta_snapshot;
                 unsigned int nb_samples_per_snapshot;
                 float delta_f1_in_float;
                 delta_snapshot = waveform_picker_regs->delta_snapshot;
                 nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];
                 delta_f1_in_float = nb_samples_per_snapshot / 2. * ( 1. / 256. - 1. / 4096.) * 256.;
                 waveform_picker_regs->delta_f1 = delta_snapshot - floor( delta_f1_in_float );
             }
             void set_wfp_delta_f2()
             {
                 unsigned int delta_snapshot;
                 unsigned int nb_samples_per_snapshot;
                 delta_snapshot = waveform_picker_regs->delta_snapshot;
                 nb_samples_per_snapshot = parameter_dump_packet.sy_lfr_n_swf_l[0] * 256 + parameter_dump_packet.sy_lfr_n_swf_l[1];
                 waveform_picker_regs->delta_f2 = delta_snapshot - nb_samples_per_snapshot / 2;
             }
             //*****************
             // local parameters
             void increment_seq_counter_source_id( unsigned char *packet_sequence_control, unsigned int sid )
             {
                 /** This function increments the parameter "sequence_cnt" depending on the sid passed in argument.
                  *
                  * @param packet_sequence_control is a pointer toward the parameter sequence_cnt to update.
                  * @param sid is the source identifier of the packet being updated.
                  *
                  * REQ-LFR-SRS-5240 / SSS-CP-FS-590
                  * The sequence counters shall wrap around from 2^14 to zero.
                  * The sequence counter shall start at zero at startup.
                  *
                  * REQ-LFR-SRS-5239 / SSS-CP-FS-580
                  * All TM_LFR_SCIENCE_ packets are sent to ground, i.e. destination id = 0
                  *
                  */
                 unsigned short *sequence_cnt;
                 unsigned short segmentation_grouping_flag;
                 unsigned short new_packet_sequence_control;
                 rtems_mode initial_mode_set;
                 rtems_mode current_mode_set;
                 rtems_status_code status;
                 //******************************************
                 // CHANGE THE MODE OF THE CALLING RTEMS TASK
                 status =  rtems_task_mode( RTEMS_NO_PREEMPT, RTEMS_PREEMPT_MASK, &initial_mode_set );
                 if ( (sid == SID_NORM_SWF_F0)    || (sid == SID_NORM_SWF_F1) || (sid == SID_NORM_SWF_F2)
                      || (sid == SID_NORM_CWF_F3) || (sid == SID_NORM_CWF_LONG_F3)
                      || (sid == SID_BURST_CWF_F2)
                      || (sid == SID_NORM_ASM_F0) || (sid == SID_NORM_ASM_F1) || (sid == SID_NORM_ASM_F2)
                      || (sid == SID_NORM_BP1_F0) || (sid == SID_NORM_BP1_F1) || (sid == SID_NORM_BP1_F2)
                      || (sid == SID_NORM_BP2_F0) || (sid == SID_NORM_BP2_F1) || (sid == SID_NORM_BP2_F2)
                      || (sid == SID_BURST_BP1_F0) || (sid == SID_BURST_BP2_F0)
                      || (sid == SID_BURST_BP1_F1) || (sid == SID_BURST_BP2_F1) )
                 {
                     sequence_cnt = (unsigned short *) &sequenceCounters_SCIENCE_NORMAL_BURST;
                 }
                 else if ( (sid ==SID_SBM1_CWF_F1) || (sid ==SID_SBM2_CWF_F2)
                           || (sid == SID_SBM1_BP1_F0) || (sid == SID_SBM1_BP2_F0)
                           || (sid == SID_SBM2_BP1_F0) || (sid == SID_SBM2_BP2_F0)
                           || (sid == SID_SBM2_BP1_F1) || (sid == SID_SBM2_BP2_F1) )
                 {
                     sequence_cnt = (unsigned short *) &sequenceCounters_SCIENCE_SBM1_SBM2;
                 }
                 else
                 {
                     sequence_cnt = (unsigned short *) NULL;
                     PRINTF1("in increment_seq_counter_source_id *** ERR apid_destid %d not known\n", sid)
                 }
                 if (sequence_cnt != NULL)
                 {
                     segmentation_grouping_flag  = TM_PACKET_SEQ_CTRL_STANDALONE << 8;
                     *sequence_cnt                = (*sequence_cnt) & 0x3fff;
                     new_packet_sequence_control = segmentation_grouping_flag | (*sequence_cnt) ;
                     packet_sequence_control[0] = (unsigned char) (new_packet_sequence_control >> 8);
                     packet_sequence_control[1] = (unsigned char) (new_packet_sequence_control     );
                     // increment the sequence counter
                     if ( *sequence_cnt < SEQ_CNT_MAX)
                     {
                         *sequence_cnt = *sequence_cnt + 1;
                     }
                     else
                     {
                         *sequence_cnt = 0;
                     }
                 }
                 //***********************************
                 // RESET THE MODE OF THE CALLING TASK
                 status =  rtems_task_mode( initial_mode_set, RTEMS_PREEMPT_MASK, &current_mode_set );
             }