##// END OF EJS Templates
Sync at CNES before going back to 117
paul -
r119:104ee7d523c0 VHDLib206
parent child
Show More
@@ -1,6 +1,6
1 #############################################################################
1 #############################################################################
2 # Makefile for building: bin/fsw
2 # Makefile for building: bin/fsw
3 # Generated by qmake (2.01a) (Qt 4.8.5) on: Tue Apr 15 07:45:50 2014
3 # Generated by qmake (2.01a) (Qt 4.8.5) on: Thu Apr 17 09:53:23 2014
4 # Project: fsw-qt.pro
4 # Project: fsw-qt.pro
5 # Template: app
5 # Template: app
6 # Command: /usr/bin/qmake-qt4 -spec /usr/lib64/qt4/mkspecs/linux-g++ -o Makefile fsw-qt.pro
6 # Command: /usr/bin/qmake-qt4 -spec /usr/lib64/qt4/mkspecs/linux-g++ -o Makefile fsw-qt.pro
@@ -10,7 +10,7
10
10
11 CC = sparc-rtems-gcc
11 CC = sparc-rtems-gcc
12 CXX = sparc-rtems-g++
12 CXX = sparc-rtems-g++
13 DEFINES = -DSW_VERSION_N1=1 -DSW_VERSION_N2=0 -DSW_VERSION_N3=0 -DSW_VERSION_N4=6 -DPRINT_MESSAGES_ON_CONSOLE -DPRINT_TASK_STATISTICS
13 DEFINES = -DSW_VERSION_N1=1 -DSW_VERSION_N2=0 -DSW_VERSION_N3=0 -DSW_VERSION_N4=6 -DPRINT_MESSAGES_ON_CONSOLE -DPRINT_TASK_STATISTICS -DBOOT_MESSAGES
14 CFLAGS = -pipe -O3 -Wall $(DEFINES)
14 CFLAGS = -pipe -O3 -Wall $(DEFINES)
15 CXXFLAGS = -pipe -O3 -Wall $(DEFINES)
15 CXXFLAGS = -pipe -O3 -Wall $(DEFINES)
16 INCPATH = -I/usr/lib64/qt4/mkspecs/linux-g++ -I. -I../src -I../header -I../src/basic_parameters
16 INCPATH = -I/usr/lib64/qt4/mkspecs/linux-g++ -I. -I../src -I../header -I../src/basic_parameters
@@ -1,7 +1,7
1 TEMPLATE = app
1 TEMPLATE = app
2 # CONFIG += console v8 sim
2 # CONFIG += console v8 sim
3 # CONFIG options = verbose *** boot_messages *** debug_messages *** cpu_usage_report *** stack_report *** vhdl_dev *** debug_tch
3 # CONFIG options = verbose *** boot_messages *** debug_messages *** cpu_usage_report *** stack_report *** vhdl_dev *** debug_tch
4 CONFIG += console verbose cpu_usage_report
4 CONFIG += console verbose cpu_usage_report boot_messages
5 CONFIG -= qt
5 CONFIG -= qt
6
6
7 include(./sparc.pri)
7 include(./sparc.pri)
@@ -1,10 +1,10
1 <?xml version="1.0" encoding="UTF-8"?>
1 <?xml version="1.0" encoding="UTF-8"?>
2 <!DOCTYPE QtCreatorProject>
2 <!DOCTYPE QtCreatorProject>
3 <!-- Written by QtCreator 3.0.1, 2014-04-16T10:43:41. -->
3 <!-- Written by QtCreator 3.0.1, 2014-04-17T09:46:14. -->
4 <qtcreator>
4 <qtcreator>
5 <data>
5 <data>
6 <variable>ProjectExplorer.Project.ActiveTarget</variable>
6 <variable>ProjectExplorer.Project.ActiveTarget</variable>
7 <value type="int">1</value>
7 <value type="int">0</value>
8 </data>
8 </data>
9 <data>
9 <data>
10 <variable>ProjectExplorer.Project.EditorSettings</variable>
10 <variable>ProjectExplorer.Project.EditorSettings</variable>
@@ -51,147 +51,9
51 <data>
51 <data>
52 <variable>ProjectExplorer.Project.Target.0</variable>
52 <variable>ProjectExplorer.Project.Target.0</variable>
53 <valuemap type="QVariantMap">
53 <valuemap type="QVariantMap">
54 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Desktop</value>
54 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Desktop-Qt 4.8.3 in PATH (System)</value>
55 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName">Desktop</value>
55 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName">Desktop-Qt 4.8.3 in PATH (System)</value>
56 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">{e04e3924-0bd8-4708-be18-f1474e45608e}</value>
56 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">{be73cf6a-f9d8-4d5a-8adf-adc2d83e2e44}</value>
57 <value type="int" key="ProjectExplorer.Target.ActiveBuildConfiguration">0</value>
58 <value type="int" key="ProjectExplorer.Target.ActiveDeployConfiguration">0</value>
59 <value type="int" key="ProjectExplorer.Target.ActiveRunConfiguration">0</value>
60 <valuemap type="QVariantMap" key="ProjectExplorer.Target.BuildConfiguration.0">
61 <value type="QString" key="ProjectExplorer.BuildConfiguration.BuildDirectory"></value>
62 <valuemap type="QVariantMap" key="ProjectExplorer.BuildConfiguration.BuildStepList.0">
63 <valuemap type="QVariantMap" key="ProjectExplorer.BuildStepList.Step.0">
64 <value type="bool" key="ProjectExplorer.BuildStep.Enabled">true</value>
65 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">qmake</value>
66 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
67 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">QtProjectManager.QMakeBuildStep</value>
68 <value type="bool" key="QtProjectManager.QMakeBuildStep.LinkQmlDebuggingLibrary">false</value>
69 <value type="bool" key="QtProjectManager.QMakeBuildStep.LinkQmlDebuggingLibraryAuto">false</value>
70 <value type="QString" key="QtProjectManager.QMakeBuildStep.QMakeArguments"></value>
71 <value type="bool" key="QtProjectManager.QMakeBuildStep.QMakeForced">false</value>
72 </valuemap>
73 <valuemap type="QVariantMap" key="ProjectExplorer.BuildStepList.Step.1">
74 <value type="bool" key="ProjectExplorer.BuildStep.Enabled">true</value>
75 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Make</value>
76 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
77 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">Qt4ProjectManager.MakeStep</value>
78 <valuelist type="QVariantList" key="Qt4ProjectManager.MakeStep.AutomaticallyAddedMakeArguments">
79 <value type="QString">-w</value>
80 <value type="QString">-r</value>
81 </valuelist>
82 <value type="bool" key="Qt4ProjectManager.MakeStep.Clean">false</value>
83 <value type="QString" key="Qt4ProjectManager.MakeStep.MakeArguments"></value>
84 <value type="QString" key="Qt4ProjectManager.MakeStep.MakeCommand"></value>
85 </valuemap>
86 <value type="int" key="ProjectExplorer.BuildStepList.StepsCount">2</value>
87 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Build</value>
88 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
89 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">ProjectExplorer.BuildSteps.Build</value>
90 </valuemap>
91 <valuemap type="QVariantMap" key="ProjectExplorer.BuildConfiguration.BuildStepList.1">
92 <valuemap type="QVariantMap" key="ProjectExplorer.BuildStepList.Step.0">
93 <value type="bool" key="ProjectExplorer.BuildStep.Enabled">true</value>
94 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Make</value>
95 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
96 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">Qt4ProjectManager.MakeStep</value>
97 <valuelist type="QVariantList" key="Qt4ProjectManager.MakeStep.AutomaticallyAddedMakeArguments">
98 <value type="QString">-w</value>
99 <value type="QString">-r</value>
100 </valuelist>
101 <value type="bool" key="Qt4ProjectManager.MakeStep.Clean">true</value>
102 <value type="QString" key="Qt4ProjectManager.MakeStep.MakeArguments">clean</value>
103 <value type="QString" key="Qt4ProjectManager.MakeStep.MakeCommand"></value>
104 </valuemap>
105 <value type="int" key="ProjectExplorer.BuildStepList.StepsCount">1</value>
106 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Clean</value>
107 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
108 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">ProjectExplorer.BuildSteps.Clean</value>
109 </valuemap>
110 <value type="int" key="ProjectExplorer.BuildConfiguration.BuildStepListCount">2</value>
111 <value type="bool" key="ProjectExplorer.BuildConfiguration.ClearSystemEnvironment">false</value>
112 <valuelist type="QVariantList" key="ProjectExplorer.BuildConfiguration.UserEnvironmentChanges"/>
113 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Release</value>
114 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
115 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">Qt4ProjectManager.Qt4BuildConfiguration</value>
116 <value type="int" key="Qt4ProjectManager.Qt4BuildConfiguration.BuildConfiguration">0</value>
117 <value type="bool" key="Qt4ProjectManager.Qt4BuildConfiguration.UseShadowBuild">true</value>
118 </valuemap>
119 <value type="int" key="ProjectExplorer.Target.BuildConfigurationCount">1</value>
120 <valuemap type="QVariantMap" key="ProjectExplorer.Target.DeployConfiguration.0">
121 <valuemap type="QVariantMap" key="ProjectExplorer.BuildConfiguration.BuildStepList.0">
122 <value type="int" key="ProjectExplorer.BuildStepList.StepsCount">0</value>
123 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Deploy</value>
124 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
125 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">ProjectExplorer.BuildSteps.Deploy</value>
126 </valuemap>
127 <value type="int" key="ProjectExplorer.BuildConfiguration.BuildStepListCount">1</value>
128 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Deploy locally</value>
129 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
130 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">ProjectExplorer.DefaultDeployConfiguration</value>
131 </valuemap>
132 <value type="int" key="ProjectExplorer.Target.DeployConfigurationCount">1</value>
133 <valuemap type="QVariantMap" key="ProjectExplorer.Target.PluginSettings"/>
134 <valuemap type="QVariantMap" key="ProjectExplorer.Target.RunConfiguration.0">
135 <valuelist type="QVariantList" key="Analyzer.Valgrind.AddedSuppressionFiles"/>
136 <value type="bool" key="Analyzer.Valgrind.Callgrind.CollectBusEvents">false</value>
137 <value type="bool" key="Analyzer.Valgrind.Callgrind.CollectSystime">false</value>
138 <value type="bool" key="Analyzer.Valgrind.Callgrind.EnableBranchSim">false</value>
139 <value type="bool" key="Analyzer.Valgrind.Callgrind.EnableCacheSim">false</value>
140 <value type="bool" key="Analyzer.Valgrind.Callgrind.EnableEventToolTips">true</value>
141 <value type="double" key="Analyzer.Valgrind.Callgrind.MinimumCostRatio">0.01</value>
142 <value type="double" key="Analyzer.Valgrind.Callgrind.VisualisationMinimumCostRatio">10</value>
143 <value type="bool" key="Analyzer.Valgrind.FilterExternalIssues">true</value>
144 <value type="int" key="Analyzer.Valgrind.LeakCheckOnFinish">1</value>
145 <value type="int" key="Analyzer.Valgrind.NumCallers">25</value>
146 <valuelist type="QVariantList" key="Analyzer.Valgrind.RemovedSuppressionFiles"/>
147 <value type="int" key="Analyzer.Valgrind.SelfModifyingCodeDetection">1</value>
148 <value type="bool" key="Analyzer.Valgrind.Settings.UseGlobalSettings">true</value>
149 <value type="bool" key="Analyzer.Valgrind.ShowReachable">false</value>
150 <value type="bool" key="Analyzer.Valgrind.TrackOrigins">true</value>
151 <value type="QString" key="Analyzer.Valgrind.ValgrindExecutable">valgrind</value>
152 <valuelist type="QVariantList" key="Analyzer.Valgrind.VisibleErrorKinds">
153 <value type="int">0</value>
154 <value type="int">1</value>
155 <value type="int">2</value>
156 <value type="int">3</value>
157 <value type="int">4</value>
158 <value type="int">5</value>
159 <value type="int">6</value>
160 <value type="int">7</value>
161 <value type="int">8</value>
162 <value type="int">9</value>
163 <value type="int">10</value>
164 <value type="int">11</value>
165 <value type="int">12</value>
166 <value type="int">13</value>
167 <value type="int">14</value>
168 </valuelist>
169 <value type="int" key="PE.EnvironmentAspect.Base">2</value>
170 <valuelist type="QVariantList" key="PE.EnvironmentAspect.Changes"/>
171 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">fsw-qt</value>
172 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName"></value>
173 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">Qt4ProjectManager.Qt4RunConfiguration:/opt/DEV_PLE/FSW-qt/fsw-qt.pro</value>
174 <value type="QString" key="Qt4ProjectManager.Qt4RunConfiguration.CommandLineArguments"></value>
175 <value type="QString" key="Qt4ProjectManager.Qt4RunConfiguration.ProFile">fsw-qt.pro</value>
176 <value type="bool" key="Qt4ProjectManager.Qt4RunConfiguration.UseDyldImageSuffix">false</value>
177 <value type="bool" key="Qt4ProjectManager.Qt4RunConfiguration.UseTerminal">true</value>
178 <value type="QString" key="Qt4ProjectManager.Qt4RunConfiguration.UserWorkingDirectory"></value>
179 <value type="uint" key="RunConfiguration.QmlDebugServerPort">3768</value>
180 <value type="bool" key="RunConfiguration.UseCppDebugger">false</value>
181 <value type="bool" key="RunConfiguration.UseCppDebuggerAuto">true</value>
182 <value type="bool" key="RunConfiguration.UseMultiProcess">false</value>
183 <value type="bool" key="RunConfiguration.UseQmlDebugger">false</value>
184 <value type="bool" key="RunConfiguration.UseQmlDebuggerAuto">true</value>
185 </valuemap>
186 <value type="int" key="ProjectExplorer.Target.RunConfigurationCount">1</value>
187 </valuemap>
188 </data>
189 <data>
190 <variable>ProjectExplorer.Project.Target.1</variable>
191 <valuemap type="QVariantMap">
192 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DefaultDisplayName">Desktop-Qt 4.8.2 in PATH (System)</value>
193 <value type="QString" key="ProjectExplorer.ProjectConfiguration.DisplayName">Desktop-Qt 4.8.2 in PATH (System)</value>
194 <value type="QString" key="ProjectExplorer.ProjectConfiguration.Id">{5289e843-9ef2-45ce-88c6-ad27d8e08def}</value>
195 <value type="int" key="ProjectExplorer.Target.ActiveBuildConfiguration">0</value>
57 <value type="int" key="ProjectExplorer.Target.ActiveBuildConfiguration">0</value>
196 <value type="int" key="ProjectExplorer.Target.ActiveDeployConfiguration">0</value>
58 <value type="int" key="ProjectExplorer.Target.ActiveDeployConfiguration">0</value>
197 <value type="int" key="ProjectExplorer.Target.ActiveRunConfiguration">0</value>
59 <value type="int" key="ProjectExplorer.Target.ActiveRunConfiguration">0</value>
@@ -326,11 +188,11
326 </data>
188 </data>
327 <data>
189 <data>
328 <variable>ProjectExplorer.Project.TargetCount</variable>
190 <variable>ProjectExplorer.Project.TargetCount</variable>
329 <value type="int">2</value>
191 <value type="int">1</value>
330 </data>
192 </data>
331 <data>
193 <data>
332 <variable>ProjectExplorer.Project.Updater.EnvironmentId</variable>
194 <variable>ProjectExplorer.Project.Updater.EnvironmentId</variable>
333 <value type="QByteArray">{2e58a81f-9962-4bba-ae6b-760177f0656c}</value>
195 <value type="QByteArray">{cdbf9cdc-1e84-406e-889b-c4feef49e75c}</value>
334 </data>
196 </data>
335 <data>
197 <data>
336 <variable>ProjectExplorer.Project.Updater.FileVersion</variable>
198 <variable>ProjectExplorer.Project.Updater.FileVersion</variable>
@@ -26,7 +26,8 int start_all_tasks( void );
26 rtems_status_code create_message_queues( void );
26 rtems_status_code create_message_queues( void );
27 rtems_status_code get_message_queue_id_send( rtems_id *queue_id );
27 rtems_status_code get_message_queue_id_send( rtems_id *queue_id );
28 rtems_status_code get_message_queue_id_recv( rtems_id *queue_id );
28 rtems_status_code get_message_queue_id_recv( rtems_id *queue_id );
29 rtems_status_code get_message_queue_id_matr( rtems_id *queue_id );
29 rtems_status_code get_message_queue_id_prc0( rtems_id *queue_id );
30 rtems_status_code get_message_queue_id_prc1( rtems_id *queue_id );
30 //
31 //
31 int start_recv_send_tasks( void );
32 int start_recv_send_tasks( void );
32 //
33 //
@@ -19,12 +19,27 typedef struct ring_node
19 } ring_node;
19 } ring_node;
20
20
21 typedef struct {
21 typedef struct {
22 // F0
22 unsigned int f0;
23 unsigned int f0;
23 unsigned int norm_bp1_f0;
24 unsigned int norm_bp1_f0;
24 unsigned int norm_bp2_f0;
25 unsigned int norm_bp2_f0;
25 unsigned int norm_asm_f0;
26 unsigned int norm_asm_f0;
26 unsigned int sbm_bp1_f0;
27 unsigned int sbm_bp1_f0;
27 unsigned int sbm_bp2_f0;
28 unsigned int sbm_bp2_f0;
29 // F1
30 unsigned int f1;
31 unsigned int norm_bp1_f1;
32 unsigned int norm_bp2_f1;
33 unsigned int norm_asm_f1;
34 unsigned int sbm_bp1_f1;
35 unsigned int sbm_bp2_f1;
36 // F2
37 unsigned int f2;
38 unsigned int norm_bp1_f2;
39 unsigned int norm_bp2_f2;
40 unsigned int norm_asm_f2;
41 unsigned int sbm_bp1_f2;
42 unsigned int sbm_bp2_f2;
28 } nb_sm_t;
43 } nb_sm_t;
29
44
30 typedef struct {
45 typedef struct {
@@ -39,7 +54,31 typedef struct {
39 unsigned int sbm1_bp2_f0;
54 unsigned int sbm1_bp2_f0;
40 unsigned int sbm2_bp1_f0;
55 unsigned int sbm2_bp1_f0;
41 unsigned int sbm2_bp2_f0;
56 unsigned int sbm2_bp2_f0;
42 } nb_sm_before_bp_t;
57 } nb_sm_before_bp_asm_f0;
58
59 typedef struct {
60 unsigned int norm_bp1_f1;
61 unsigned int norm_bp2_f1;
62 unsigned int norm_asm_f1;
63 unsigned int burst_sbm_bp1_f1;
64 unsigned int burst_sbm_bp2_f1;
65 unsigned int burst_bp1_f1;
66 unsigned int burst_bp2_f1;
67 unsigned int sbm2_bp1_f1;
68 unsigned int sbm2_bp2_f1;
69 } nb_sm_before_bp_asm_f1;
70
71 typedef struct {
72 unsigned int norm_bp1_f2;
73 unsigned int norm_bp2_f2;
74 unsigned int norm_asm_f2;
75 unsigned int burst_sbm_bp1_f2;
76 unsigned int burst_sbm_bp2_f2;
77 unsigned int burst_bp1_f2;
78 unsigned int burst_bp2_f2;
79 unsigned int sbm2_bp1_f2;
80 unsigned int sbm2_bp2_f2;
81 } nb_sm_before_bp_asm_f2;
43
82
44 //************************
83 //************************
45 // flight software version
84 // flight software version
@@ -87,8 +126,18 typedef struct {
87 #define RTEMS_EVENT_NORM_BP1_F0 RTEMS_EVENT_6
126 #define RTEMS_EVENT_NORM_BP1_F0 RTEMS_EVENT_6
88 #define RTEMS_EVENT_NORM_BP2_F0 RTEMS_EVENT_7
127 #define RTEMS_EVENT_NORM_BP2_F0 RTEMS_EVENT_7
89 #define RTEMS_EVENT_NORM_ASM_F0 RTEMS_EVENT_8
128 #define RTEMS_EVENT_NORM_ASM_F0 RTEMS_EVENT_8
90 #define RTEMS_EVENT_BURST_SBM_BP1_F0 RTEMS_EVENT_9
129 #define RTEMS_EVENT_NORM_BP1_F1 RTEMS_EVENT_9
91 #define RTEMS_EVENT_BURST_SBM_BP2_F0 RTEMS_EVENT_10
130 #define RTEMS_EVENT_NORM_BP2_F1 RTEMS_EVENT_10
131 #define RTEMS_EVENT_NORM_ASM_F1 RTEMS_EVENT_11
132 #define RTEMS_EVENT_NORM_BP1_F2 RTEMS_EVENT_12
133 #define RTEMS_EVENT_NORM_BP2_F2 RTEMS_EVENT_13
134 #define RTEMS_EVENT_NORM_ASM_F2 RTEMS_EVENT_14
135 #define RTEMS_EVENT_BURST_SBM_BP1_F0 RTEMS_EVENT_15
136 #define RTEMS_EVENT_BURST_SBM_BP2_F0 RTEMS_EVENT_16
137 #define RTEMS_EVENT_BURST_SBM_BP1_F1 RTEMS_EVENT_17
138 #define RTEMS_EVENT_BURST_SBM_BP2_F1 RTEMS_EVENT_18
139 #define RTEMS_EVENT_BURST_SBM_BP1_F2 RTEMS_EVENT_19
140 #define RTEMS_EVENT_BURST_SBM_BP2_F2 RTEMS_EVENT_20
92
141
93 //****************************
142 //****************************
94 // LFR DEFAULT MODE PARAMETERS
143 // LFR DEFAULT MODE PARAMETERS
@@ -173,7 +222,7 typedef struct {
173 #define TASKID_WFRM 8
222 #define TASKID_WFRM 8
174 #define TASKID_DUMB 9
223 #define TASKID_DUMB 9
175 #define TASKID_HOUS 10
224 #define TASKID_HOUS 10
176 #define TASKID_MATR 11
225 #define TASKID_PRC0 11
177 #define TASKID_CWF3 12
226 #define TASKID_CWF3 12
178 #define TASKID_CWF2 13
227 #define TASKID_CWF2 13
179 #define TASKID_CWF1 14
228 #define TASKID_CWF1 14
@@ -194,21 +243,24 typedef struct {
194 #define TASK_PRIORITY_ACTN 50
243 #define TASK_PRIORITY_ACTN 50
195 #define TASK_PRIORITY_AVF0 60
244 #define TASK_PRIORITY_AVF0 60
196 #define TASK_PRIORITY_BPF0 60
245 #define TASK_PRIORITY_BPF0 60
197 #define TASK_PRIORITY_MATR 100
246 #define TASK_PRIORITY_PRC0 100
198 #define TASK_PRIORITY_STAT 200
247 #define TASK_PRIORITY_STAT 200
199 #define TASK_PRIORITY_DUMB 200
248 #define TASK_PRIORITY_DUMB 200
200
249
201 #define MSG_QUEUE_COUNT_RECV 10
250 #define MSG_QUEUE_COUNT_RECV 10
202 #define MSG_QUEUE_COUNT_SEND 50
251 #define MSG_QUEUE_COUNT_SEND 50
203 #define MSG_QUEUE_COUNT_MATR 10
252 #define MSG_QUEUE_COUNT_PRC0 10
253 #define MSG_QUEUE_COUNT_PRC1 10
204 //#define MSG_QUEUE_SIZE_SEND (PACKET_LENGTH_HK + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES)
254 //#define MSG_QUEUE_SIZE_SEND (PACKET_LENGTH_HK + CCSDS_TC_TM_PACKET_OFFSET + CCSDS_PROTOCOLE_EXTRA_BYTES)
205 #define MSG_QUEUE_SIZE_SEND 810 // 806 + 4 => TM_LFR_SCIENCE_BURST_BP2_F1
255 #define MSG_QUEUE_SIZE_SEND 810 // 806 + 4 => TM_LFR_SCIENCE_BURST_BP2_F1
206 #define ACTION_MSG_SPW_IOCTL_SEND_SIZE 24 // hlen *hdr dlen *data sent options
256 #define ACTION_MSG_SPW_IOCTL_SEND_SIZE 24 // hlen *hdr dlen *data sent options
207 #define MSG_QUEUE_SIZE_MATR 20 // two pointers and one rtems_event + 2 integers
257 #define MSG_QUEUE_SIZE_PRC0 20 // two pointers and one rtems_event + 2 integers
258 #define MSG_QUEUE_SIZE_PRC1 20 // two pointers and one rtems_event + 2 integers
208
259
209 #define QUEUE_RECV 0
260 #define QUEUE_RECV 0
210 #define QUEUE_SEND 1
261 #define QUEUE_SEND 1
211 #define QUEUE_MATR 2
262 #define QUEUE_PRC0 2
263 #define QUEUE_PRC1 3
212
264
213 //*******
265 //*******
214 // MACROS
266 // MACROS
@@ -63,5 +63,6
63 #define NB_SM_BEFORE_SBM2_BP2_F0 480 // 480 matrices at f0 = 5.00 second
63 #define NB_SM_BEFORE_SBM2_BP2_F0 480 // 480 matrices at f0 = 5.00 second
64 // GENERAL
64 // GENERAL
65 #define NB_SM_BEFORE_AVF0 8
65 #define NB_SM_BEFORE_AVF0 8
66 #define NB_SM_BEFORE_AVF1 8
66
67
67 #endif // FSW_PARAMS_PROCESSING_H
68 #endif // FSW_PARAMS_PROCESSING_H
@@ -43,15 +43,17 typedef struct bp_packet_with_spare
43
43
44 typedef struct asm_msg
44 typedef struct asm_msg
45 {
45 {
46 ring_node_asm *norm_f0;
46 ring_node_asm *norm;
47 ring_node_asm *burst_sbmf0;
47 ring_node_asm *burst_sbm;
48 rtems_event_set event;
48 rtems_event_set event;
49 unsigned int coarseTime;
49 unsigned int coarseTime;
50 unsigned int fineTime;
50 unsigned int fineTime;
51 } asm_msg;
51 } asm_msg;
52
52
53 extern nb_sm_t nb_sm;
53 extern nb_sm_t nb_sm;
54 extern nb_sm_before_bp_t nb_sm_before_bp;
54 extern nb_sm_before_bp_asm_f0 nb_sm_before_f0;
55 extern nb_sm_before_bp_asm_f1 nb_sm_before_f1;
56 extern nb_sm_before_bp_asm_f2 nb_sm_before_f2;
55
57
56 extern volatile int sm_f0[ ];
58 extern volatile int sm_f0[ ];
57 extern volatile int sm_f1[ ];
59 extern volatile int sm_f1[ ];
@@ -75,7 +77,7 rtems_isr spectral_matrices_isr_simu( rt
75 // RTEMS TASKS
77 // RTEMS TASKS
76 rtems_task smiq_task( rtems_task_argument argument ); // added to test the spectral matrix simulator
78 rtems_task smiq_task( rtems_task_argument argument ); // added to test the spectral matrix simulator
77 rtems_task avf0_task( rtems_task_argument lfrRequestedMode );
79 rtems_task avf0_task( rtems_task_argument lfrRequestedMode );
78 rtems_task matr_task( rtems_task_argument lfrRequestedMode );
80 rtems_task prc0_task( rtems_task_argument lfrRequestedMode );
79
81
80 //******************
82 //******************
81 // Spectral Matrices
83 // Spectral Matrices
@@ -115,6 +117,7 void BP_send(char *data,
115 void reset_spectral_matrix_regs( void );
117 void reset_spectral_matrix_regs( void );
116 void set_time(unsigned char *time, unsigned char *timeInBuffer );
118 void set_time(unsigned char *time, unsigned char *timeInBuffer );
117
119
118 extern rtems_status_code get_message_queue_id_matr( rtems_id *queue_id );
120 extern rtems_status_code get_message_queue_id_prc0( rtems_id *queue_id );
121 extern rtems_status_code get_message_queue_id_prc1( rtems_id *queue_id );
119
122
120 #endif // FSW_PROCESSING_H_INCLUDED
123 #endif // FSW_PROCESSING_H_INCLUDED
@@ -10,7 +10,9
10 #include "fsw_misc.h"
10 #include "fsw_misc.h"
11
11
12 extern nb_sm_t nb_sm;
12 extern nb_sm_t nb_sm;
13 extern nb_sm_before_bp_t nb_sm_before_bp;
13 extern nb_sm_before_bp_asm_f0 nb_sm_before_f0;
14 extern nb_sm_before_bp_asm_f1 nb_sm_before_f1;
15 extern nb_sm_before_bp_asm_f2 nb_sm_before_f2;
14
16
15 int action_load_common_par( ccsdsTelecommandPacket_t *TC );
17 int action_load_common_par( ccsdsTelecommandPacket_t *TC );
16 int action_load_normal_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time);
18 int action_load_normal_par(ccsdsTelecommandPacket_t *TC, rtems_id queue_id , unsigned char *time);
@@ -49,7 +49,9 char wf_cont_f3_light[ (NB_SAMPL
49 // SPECTRAL MATRICES GLOBAL VARIABLES
49 // SPECTRAL MATRICES GLOBAL VARIABLES
50
50
51 nb_sm_t nb_sm;
51 nb_sm_t nb_sm;
52 nb_sm_before_bp_t nb_sm_before_bp;
52 nb_sm_before_bp_asm_f0 nb_sm_before_f0;
53 nb_sm_before_bp_asm_f1 nb_sm_before_f1;
54 nb_sm_before_bp_asm_f2 nb_sm_before_f2;
53
55
54 // alignment constraints for the spectral matrices buffers => the first data after the time (8 bytes) shall be aligned on 0x00
56 // alignment constraints for the spectral matrices buffers => the first data after the time (8 bytes) shall be aligned on 0x00
55 volatile int sm_f0[ NB_RING_NODES_SM_F0 * TOTAL_SIZE_SM ] __attribute__((aligned(0x100)));
57 volatile int sm_f0[ NB_RING_NODES_SM_F0 * TOTAL_SIZE_SM ] __attribute__((aligned(0x100)));
@@ -35,7 +35,7
35 #define CONFIGURE_MAXIMUM_DRIVERS 16
35 #define CONFIGURE_MAXIMUM_DRIVERS 16
36 #define CONFIGURE_MAXIMUM_PERIODS 5
36 #define CONFIGURE_MAXIMUM_PERIODS 5
37 #define CONFIGURE_MAXIMUM_TIMERS 5 // STAT (1s), send SWF (0.3s), send CWF3 (1s)
37 #define CONFIGURE_MAXIMUM_TIMERS 5 // STAT (1s), send SWF (0.3s), send CWF3 (1s)
38 #define CONFIGURE_MAXIMUM_MESSAGE_QUEUES 3
38 #define CONFIGURE_MAXIMUM_MESSAGE_QUEUES 4
39 #ifdef PRINT_STACK_REPORT
39 #ifdef PRINT_STACK_REPORT
40 #define CONFIGURE_STACK_CHECKER_ENABLED
40 #define CONFIGURE_STACK_CHECKER_ENABLED
41 #endif
41 #endif
@@ -86,8 +86,8 rtems_task Init( rtems_task_argument ign
86 PRINTF("*************************\n")
86 PRINTF("*************************\n")
87 PRINTF("** LFR Flight Software **\n")
87 PRINTF("** LFR Flight Software **\n")
88 PRINTF1("** %d.", SW_VERSION_N1)
88 PRINTF1("** %d.", SW_VERSION_N1)
89 PRINTF1("%d.", SW_VERSION_N2)
89 PRINTF1("%d." , SW_VERSION_N2)
90 PRINTF1("%d.", SW_VERSION_N3)
90 PRINTF1("%d." , SW_VERSION_N3)
91 PRINTF1("%d **\n", SW_VERSION_N4)
91 PRINTF1("%d **\n", SW_VERSION_N4)
92 PRINTF("*************************\n")
92 PRINTF("*************************\n")
93 PRINTF("\n\n")
93 PRINTF("\n\n")
@@ -256,7 +256,7 void create_names( void ) // create all
256 Task_name[TASKID_WFRM] = rtems_build_name( 'W', 'F', 'R', 'M' );
256 Task_name[TASKID_WFRM] = rtems_build_name( 'W', 'F', 'R', 'M' );
257 Task_name[TASKID_DUMB] = rtems_build_name( 'D', 'U', 'M', 'B' );
257 Task_name[TASKID_DUMB] = rtems_build_name( 'D', 'U', 'M', 'B' );
258 Task_name[TASKID_HOUS] = rtems_build_name( 'H', 'O', 'U', 'S' );
258 Task_name[TASKID_HOUS] = rtems_build_name( 'H', 'O', 'U', 'S' );
259 Task_name[TASKID_MATR] = rtems_build_name( 'M', 'A', 'T', 'R' );
259 Task_name[TASKID_PRC0] = rtems_build_name( 'P', 'R', 'C', '0' );
260 Task_name[TASKID_CWF3] = rtems_build_name( 'C', 'W', 'F', '3' );
260 Task_name[TASKID_CWF3] = rtems_build_name( 'C', 'W', 'F', '3' );
261 Task_name[TASKID_CWF2] = rtems_build_name( 'C', 'W', 'F', '2' );
261 Task_name[TASKID_CWF2] = rtems_build_name( 'C', 'W', 'F', '2' );
262 Task_name[TASKID_CWF1] = rtems_build_name( 'C', 'W', 'F', '1' );
262 Task_name[TASKID_CWF1] = rtems_build_name( 'C', 'W', 'F', '1' );
@@ -268,7 +268,8 void create_names( void ) // create all
268
268
269 misc_name[QUEUE_RECV] = rtems_build_name( 'Q', '_', 'R', 'V' );
269 misc_name[QUEUE_RECV] = rtems_build_name( 'Q', '_', 'R', 'V' );
270 misc_name[QUEUE_SEND] = rtems_build_name( 'Q', '_', 'S', 'D' );
270 misc_name[QUEUE_SEND] = rtems_build_name( 'Q', '_', 'S', 'D' );
271 misc_name[QUEUE_MATR] = rtems_build_name( 'Q', '_', 'M', 'R' );
271 misc_name[QUEUE_PRC0] = rtems_build_name( 'Q', '_', 'P', '0' );
272 misc_name[QUEUE_PRC1] = rtems_build_name( 'Q', '_', 'P', '1' );
272 }
273 }
273
274
274 int create_all_tasks( void ) // create all tasks which run in the software
275 int create_all_tasks( void ) // create all tasks which run in the software
@@ -351,9 +352,9 int create_all_tasks( void ) // create a
351 if (status == RTEMS_SUCCESSFUL) // MATR
352 if (status == RTEMS_SUCCESSFUL) // MATR
352 {
353 {
353 status = rtems_task_create(
354 status = rtems_task_create(
354 Task_name[TASKID_MATR], TASK_PRIORITY_MATR, RTEMS_MINIMUM_STACK_SIZE * 2,
355 Task_name[TASKID_PRC0], TASK_PRIORITY_PRC0, RTEMS_MINIMUM_STACK_SIZE * 2,
355 RTEMS_DEFAULT_MODES,
356 RTEMS_DEFAULT_MODES,
356 RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_MATR]
357 RTEMS_DEFAULT_ATTRIBUTES | RTEMS_FLOATING_POINT, &Task_id[TASKID_PRC0]
357 );
358 );
358 }
359 }
359
360
@@ -507,11 +508,11 int start_all_tasks( void ) // start all
507 }
508 }
508 }
509 }
509
510
510 if (status == RTEMS_SUCCESSFUL) // MATR
511 if (status == RTEMS_SUCCESSFUL) // PRC0
511 {
512 {
512 status = rtems_task_start( Task_id[TASKID_MATR], matr_task, 1 );
513 status = rtems_task_start( Task_id[TASKID_PRC0], prc0_task, 1 );
513 if (status!=RTEMS_SUCCESSFUL) {
514 if (status!=RTEMS_SUCCESSFUL) {
514 BOOT_PRINTF("in INIT *** Error starting TASK_MATR\n")
515 BOOT_PRINTF("in INIT *** Error starting TASK_PRC0\n")
515 }
516 }
516 }
517 }
517
518
@@ -612,15 +613,24 rtems_status_code create_message_queues(
612 PRINTF1("in create_message_queues *** ERR creating PKTS queue, %d\n", status_send)
613 PRINTF1("in create_message_queues *** ERR creating PKTS queue, %d\n", status_send)
613 }
614 }
614
615
615 //************************************************************************
616 //*****************************************************************************
616 // create the queue for handling averaged spectral matrices for processing
617 // create the queue for handling averaged spectral matrices for processing @ f0
617 status_matr = rtems_message_queue_create( misc_name[QUEUE_MATR],
618 status_matr = rtems_message_queue_create( misc_name[QUEUE_PRC0],
618 MSG_QUEUE_COUNT_MATR, MSG_QUEUE_SIZE_MATR,
619 MSG_QUEUE_COUNT_PRC0, MSG_QUEUE_SIZE_PRC0,
619 RTEMS_FIFO | RTEMS_LOCAL, &queue_id );
620 RTEMS_FIFO | RTEMS_LOCAL, &queue_id );
620 if ( status_send != RTEMS_SUCCESSFUL ) {
621 if ( status_send != RTEMS_SUCCESSFUL ) {
621 PRINTF1("in create_message_queues *** ERR creating MATR queue, %d\n", status_matr)
622 PRINTF1("in create_message_queues *** ERR creating PR_0 queue, %d\n", status_matr)
622 }
623 }
623
624
625 //*****************************************************************************
626 // create the queue for handling averaged spectral matrices for processing @ f1
627 // status_matr = rtems_message_queue_create( misc_name[QUEUE_PRC1],
628 // MSG_QUEUE_COUNT_PRC1, MSG_QUEUE_SIZE_PRC1,
629 // RTEMS_FIFO | RTEMS_LOCAL, &queue_id );
630 // if ( status_send != RTEMS_SUCCESSFUL ) {
631 // PRINTF1("in create_message_queues *** ERR creating PR_1 queue, %d\n", status_matr)
632 // }
633
624 if ( status_recv != RTEMS_SUCCESSFUL )
634 if ( status_recv != RTEMS_SUCCESSFUL )
625 {
635 {
626 ret = status_recv;
636 ret = status_recv;
@@ -661,14 +671,26 rtems_status_code get_message_queue_id_r
661 return status;
671 return status;
662 }
672 }
663
673
664 rtems_status_code get_message_queue_id_matr( rtems_id *queue_id )
674 rtems_status_code get_message_queue_id_prc0( rtems_id *queue_id )
665 {
675 {
666 rtems_status_code status;
676 rtems_status_code status;
667 rtems_name queue_name;
677 rtems_name queue_name;
668
678
669 queue_name = rtems_build_name( 'Q', '_', 'M', 'R' );
679 queue_name = rtems_build_name( 'Q', '_', 'P', '0' );
670
680
671 status = rtems_message_queue_ident( queue_name, 0, queue_id );
681 status = rtems_message_queue_ident( queue_name, 0, queue_id );
672
682
673 return status;
683 return status;
674 }
684 }
685
686 rtems_status_code get_message_queue_id_prc1( rtems_id *queue_id )
687 {
688 rtems_status_code status;
689 rtems_name queue_name;
690
691 queue_name = rtems_build_name( 'Q', '_', 'P', '1' );
692
693 status = rtems_message_queue_ident( queue_name, 0, queue_id );
694
695 return status;
696 }
This diff has been collapsed as it changes many lines, (525 lines changed) Show them Hide them
@@ -17,14 +17,17 ring_node_sm sm_ring_f0[ NB_RING_NODES_S
17 ring_node_sm sm_ring_f1[ NB_RING_NODES_SM_F1 ];
17 ring_node_sm sm_ring_f1[ NB_RING_NODES_SM_F1 ];
18 ring_node_sm sm_ring_f2[ NB_RING_NODES_SM_F2 ];
18 ring_node_sm sm_ring_f2[ NB_RING_NODES_SM_F2 ];
19 ring_node_sm *current_ring_node_sm_f0;
19 ring_node_sm *current_ring_node_sm_f0;
20 ring_node_sm *ring_node_for_averaging_sm_f0;
21 ring_node_sm *current_ring_node_sm_f1;
20 ring_node_sm *current_ring_node_sm_f1;
22 ring_node_sm *current_ring_node_sm_f2;
21 ring_node_sm *current_ring_node_sm_f2;
22 ring_node_sm *ring_node_for_averaging_sm_f0;
23 ring_node_sm *ring_node_for_averaging_sm_f1;
23
24
24 ring_node_asm asm_ring_burst_sbm_f0[ NB_RING_NODES_ASM_BURST_SBM_F0 ];
25 ring_node_asm asm_ring_burst_sbm_f0[ NB_RING_NODES_ASM_BURST_SBM_F0 ];
25 ring_node_asm asm_ring_norm_f0 [ NB_RING_NODES_ASM_BURST_SBM_F0 ];
26 ring_node_asm asm_ring_norm_f0 [ NB_RING_NODES_ASM_BURST_SBM_F0 ];
26 ring_node_asm *current_ring_node_asm_burst_sbm_f0;
27 ring_node_asm *current_ring_node_asm_burst_sbm_f0;
28 ring_node_asm *current_ring_node_asm_burst_sbm_f1;
27 ring_node_asm *current_ring_node_asm_norm_f0;
29 ring_node_asm *current_ring_node_asm_norm_f0;
30 ring_node_asm *current_ring_node_asm_norm_f1;
28
31
29 float asm_norm_f0 [ TOTAL_SIZE_SM ];
32 float asm_norm_f0 [ TOTAL_SIZE_SM ];
30 float asm_f0_reorganized [ TOTAL_SIZE_SM ];
33 float asm_f0_reorganized [ TOTAL_SIZE_SM ];
@@ -43,35 +46,103 void reset_nb_sm_f0( unsigned char lfrMo
43 nb_sm.sbm_bp1_f0 = 0;
46 nb_sm.sbm_bp1_f0 = 0;
44 nb_sm.sbm_bp2_f0 = 0;
47 nb_sm.sbm_bp2_f0 = 0;
45
48
46 nb_sm_before_bp.norm_bp1_f0 = parameter_dump_packet.sy_lfr_n_bp_p0 * 96;
49 nb_sm_before_f0.norm_bp1_f0 = parameter_dump_packet.sy_lfr_n_bp_p0 * 96;
47 nb_sm_before_bp.norm_bp2_f0 = parameter_dump_packet.sy_lfr_n_bp_p1 * 96;
50 nb_sm_before_f0.norm_bp2_f0 = parameter_dump_packet.sy_lfr_n_bp_p1 * 96;
48 nb_sm_before_bp.norm_asm_f0 = (parameter_dump_packet.sy_lfr_n_asm_p[0] * 256 + parameter_dump_packet.sy_lfr_n_asm_p[1]) * 96;
51 nb_sm_before_f0.norm_asm_f0 = (parameter_dump_packet.sy_lfr_n_asm_p[0] * 256 + parameter_dump_packet.sy_lfr_n_asm_p[1]) * 96;
49 nb_sm_before_bp.sbm1_bp1_f0 = parameter_dump_packet.sy_lfr_s1_bp_p0 * 24;
52 nb_sm_before_f0.sbm1_bp1_f0 = parameter_dump_packet.sy_lfr_s1_bp_p0 * 24;
50 nb_sm_before_bp.sbm1_bp2_f0 = parameter_dump_packet.sy_lfr_s1_bp_p1 * 96;
53 nb_sm_before_f0.sbm1_bp2_f0 = parameter_dump_packet.sy_lfr_s1_bp_p1 * 96;
51 nb_sm_before_bp.sbm2_bp1_f0 = parameter_dump_packet.sy_lfr_s2_bp_p0 * 96;
54 nb_sm_before_f0.sbm2_bp1_f0 = parameter_dump_packet.sy_lfr_s2_bp_p0 * 96;
52 nb_sm_before_bp.sbm2_bp2_f0 = parameter_dump_packet.sy_lfr_s2_bp_p1 * 96;
55 nb_sm_before_f0.sbm2_bp2_f0 = parameter_dump_packet.sy_lfr_s2_bp_p1 * 96;
53 nb_sm_before_bp.burst_bp1_f0 = parameter_dump_packet.sy_lfr_b_bp_p0 * 96;
56 nb_sm_before_f0.burst_bp1_f0 = parameter_dump_packet.sy_lfr_b_bp_p0 * 96;
54 nb_sm_before_bp.burst_bp2_f0 = parameter_dump_packet.sy_lfr_b_bp_p1 * 96;
57 nb_sm_before_f0.burst_bp2_f0 = parameter_dump_packet.sy_lfr_b_bp_p1 * 96;
55
58
56 if (lfrMode == LFR_MODE_SBM1)
59 if (lfrMode == LFR_MODE_SBM1)
57 {
60 {
58 nb_sm_before_bp.burst_sbm_bp1_f0 = nb_sm_before_bp.sbm1_bp1_f0;
61 nb_sm_before_f0.burst_sbm_bp1_f0 = nb_sm_before_f0.sbm1_bp1_f0;
59 nb_sm_before_bp.burst_sbm_bp2_f0 = nb_sm_before_bp.sbm1_bp2_f0;
62 nb_sm_before_f0.burst_sbm_bp2_f0 = nb_sm_before_f0.sbm1_bp2_f0;
60 }
63 }
61 else if (lfrMode == LFR_MODE_SBM2)
64 else if (lfrMode == LFR_MODE_SBM2)
62 {
65 {
63 nb_sm_before_bp.burst_sbm_bp1_f0 = nb_sm_before_bp.sbm2_bp1_f0;
66 nb_sm_before_f0.burst_sbm_bp1_f0 = nb_sm_before_f0.sbm2_bp1_f0;
64 nb_sm_before_bp.burst_sbm_bp2_f0 = nb_sm_before_bp.sbm2_bp2_f0;
67 nb_sm_before_f0.burst_sbm_bp2_f0 = nb_sm_before_f0.sbm2_bp2_f0;
68 }
69 else if (lfrMode == LFR_MODE_BURST)
70 {
71 nb_sm_before_f0.burst_sbm_bp1_f0 = nb_sm_before_f0.burst_bp1_f0;
72 nb_sm_before_f0.burst_sbm_bp2_f0 = nb_sm_before_f0.burst_bp2_f0;
73 }
74 else
75 {
76 nb_sm_before_f0.burst_sbm_bp1_f0 = nb_sm_before_f0.burst_bp1_f0;
77 nb_sm_before_f0.burst_sbm_bp2_f0 = nb_sm_before_f0.burst_bp2_f0;
78 }
79 }
80
81 void reset_nb_sm_f1( unsigned char lfrMode )
82 {
83 nb_sm.f1 = 0;
84 nb_sm.norm_bp1_f1 = 0;
85 nb_sm.norm_bp2_f1 = 0;
86 nb_sm.norm_asm_f1 = 0;
87 nb_sm.sbm_bp1_f1 = 0;
88 nb_sm.sbm_bp2_f1 = 0;
89
90 nb_sm_before_f1.norm_bp1_f1 = parameter_dump_packet.sy_lfr_n_bp_p0 * 16;
91 nb_sm_before_f1.norm_bp2_f1 = parameter_dump_packet.sy_lfr_n_bp_p1 * 16;
92 nb_sm_before_f1.norm_asm_f1 = (parameter_dump_packet.sy_lfr_n_asm_p[0] * 256 + parameter_dump_packet.sy_lfr_n_asm_p[1]) * 16;
93 nb_sm_before_f1.sbm2_bp1_f1 = parameter_dump_packet.sy_lfr_s2_bp_p0 * 16;
94 nb_sm_before_f1.sbm2_bp2_f1 = parameter_dump_packet.sy_lfr_s2_bp_p1 * 16;
95 nb_sm_before_f1.burst_bp1_f1 = parameter_dump_packet.sy_lfr_b_bp_p0 * 16;
96 nb_sm_before_f1.burst_bp2_f1 = parameter_dump_packet.sy_lfr_b_bp_p1 * 16;
97
98 if (lfrMode == LFR_MODE_SBM2)
99 {
100 nb_sm_before_f1.burst_sbm_bp1_f1 = nb_sm_before_f1.sbm2_bp1_f1;
101 nb_sm_before_f1.burst_sbm_bp2_f1 = nb_sm_before_f1.sbm2_bp2_f1;
65 }
102 }
66 else if (lfrMode == LFR_MODE_BURST)
103 else if (lfrMode == LFR_MODE_BURST)
67 {
104 {
68 nb_sm_before_bp.burst_sbm_bp1_f0 = nb_sm_before_bp.burst_bp1_f0;
105 nb_sm_before_f1.burst_sbm_bp1_f1 = nb_sm_before_f1.burst_bp1_f1;
69 nb_sm_before_bp.burst_sbm_bp2_f0 = nb_sm_before_bp.burst_bp2_f0;
106 nb_sm_before_f1.burst_sbm_bp2_f1 = nb_sm_before_f1.burst_bp2_f1;
70 }
107 }
71 else
108 else
72 {
109 {
73 nb_sm_before_bp.burst_sbm_bp1_f0 = nb_sm_before_bp.burst_bp1_f0;
110 nb_sm_before_f1.burst_sbm_bp1_f1 = nb_sm_before_f1.burst_bp1_f1;
74 nb_sm_before_bp.burst_sbm_bp2_f0 = nb_sm_before_bp.burst_bp2_f0;
111 nb_sm_before_f1.burst_sbm_bp2_f1 = nb_sm_before_f1.burst_bp2_f1;
112 }
113 }
114
115 void reset_nb_sm_f2( unsigned char lfrMode )
116 {
117 nb_sm.f2 = 0;
118 nb_sm.norm_bp1_f2 = 0;
119 nb_sm.norm_bp2_f2 = 0;
120 nb_sm.norm_asm_f2 = 0;
121 nb_sm.sbm_bp1_f2 = 0;
122 nb_sm.sbm_bp2_f2 = 0;
123
124 nb_sm_before_f2.norm_bp1_f2 = parameter_dump_packet.sy_lfr_n_bp_p0;
125 nb_sm_before_f2.norm_bp2_f2 = parameter_dump_packet.sy_lfr_n_bp_p1;
126 nb_sm_before_f2.norm_asm_f2 = parameter_dump_packet.sy_lfr_n_asm_p[0] * 256 + parameter_dump_packet.sy_lfr_n_asm_p[1];
127 nb_sm_before_f2.sbm2_bp1_f2 = parameter_dump_packet.sy_lfr_s2_bp_p0;
128 nb_sm_before_f2.sbm2_bp2_f2 = parameter_dump_packet.sy_lfr_s2_bp_p1;
129 nb_sm_before_f2.burst_bp1_f2 = parameter_dump_packet.sy_lfr_b_bp_p0;
130 nb_sm_before_f2.burst_bp2_f2 = parameter_dump_packet.sy_lfr_b_bp_p1;
131
132 if (lfrMode == LFR_MODE_SBM2)
133 {
134 nb_sm_before_f2.burst_sbm_bp1_f2 = nb_sm_before_f2.sbm2_bp1_f2;
135 nb_sm_before_f2.burst_sbm_bp2_f2 = nb_sm_before_f2.sbm2_bp2_f2;
136 }
137 else if (lfrMode == LFR_MODE_BURST)
138 {
139 nb_sm_before_f2.burst_sbm_bp1_f2 = nb_sm_before_f2.burst_bp1_f2;
140 nb_sm_before_f2.burst_sbm_bp2_f2 = nb_sm_before_f2.burst_bp2_f2;
141 }
142 else
143 {
144 nb_sm_before_f2.burst_sbm_bp1_f2 = nb_sm_before_f2.burst_bp1_f2;
145 nb_sm_before_f2.burst_sbm_bp2_f2 = nb_sm_before_f2.burst_bp2_f2;
75 }
146 }
76 }
147 }
77
148
@@ -152,7 +223,7 rtems_task avf0_task( rtems_task_argumen
152
223
153 rtems_event_set event_out;
224 rtems_event_set event_out;
154 rtems_status_code status;
225 rtems_status_code status;
155 rtems_id queue_id_matr;
226 rtems_id queue_id_prc0;
156 asm_msg msgForMATR;
227 asm_msg msgForMATR;
157 ring_node_sm *ring_node_tab[8];
228 ring_node_sm *ring_node_tab[8];
158
229
@@ -160,10 +231,10 rtems_task avf0_task( rtems_task_argumen
160
231
161 BOOT_PRINTF1("in AVFO *** lfrRequestedMode = %d\n", lfrRequestedMode)
232 BOOT_PRINTF1("in AVFO *** lfrRequestedMode = %d\n", lfrRequestedMode)
162
233
163 status = get_message_queue_id_matr( &queue_id_matr );
234 status = get_message_queue_id_prc0( &queue_id_prc0 );
164 if (status != RTEMS_SUCCESSFUL)
235 if (status != RTEMS_SUCCESSFUL)
165 {
236 {
166 PRINTF1("in MATR *** ERR get_message_queue_id_matr %d\n", status)
237 PRINTF1("in MATR *** ERR get_message_queue_id_prc0 %d\n", status)
167 }
238 }
168
239
169 while(1){
240 while(1){
@@ -190,13 +261,13 rtems_task avf0_task( rtems_task_argumen
190
261
191 //****************************************
262 //****************************************
192 // initialize the mesage for the MATR task
263 // initialize the mesage for the MATR task
193 msgForMATR.event = 0x00; // this composite event will be sent to the MATR task
264 msgForMATR.event = 0x00; // this composite event will be sent to the MATR task
194 msgForMATR.burst_sbmf0 = current_ring_node_asm_burst_sbm_f0;
265 msgForMATR.burst_sbm = current_ring_node_asm_burst_sbm_f0;
195 msgForMATR.norm_f0 = current_ring_node_asm_norm_f0;
266 msgForMATR.norm = current_ring_node_asm_norm_f0;
196 msgForMATR.coarseTime = ( (unsigned int *) (ring_node_tab[0]->buffer_address) )[0];
267 msgForMATR.coarseTime = ( (unsigned int *) (ring_node_tab[0]->buffer_address) )[0];
197 msgForMATR.fineTime = ( (unsigned int *) (ring_node_tab[0]->buffer_address) )[1];
268 msgForMATR.fineTime = ( (unsigned int *) (ring_node_tab[0]->buffer_address) )[1];
198
269
199 if (nb_sm.sbm_bp1_f0 == nb_sm_before_bp.burst_sbm_bp1_f0)
270 if (nb_sm.sbm_bp1_f0 == nb_sm_before_f0.burst_sbm_bp1_f0)
200 {
271 {
201 nb_sm.sbm_bp1_f0 = 0;
272 nb_sm.sbm_bp1_f0 = 0;
202 // set another ring for the ASM storage
273 // set another ring for the ASM storage
@@ -208,7 +279,7 rtems_task avf0_task( rtems_task_argumen
208 }
279 }
209 }
280 }
210
281
211 if (nb_sm.sbm_bp2_f0 == nb_sm_before_bp.burst_sbm_bp2_f0)
282 if (nb_sm.sbm_bp2_f0 == nb_sm_before_f0.burst_sbm_bp2_f0)
212 {
283 {
213 nb_sm.sbm_bp2_f0 = 0;
284 nb_sm.sbm_bp2_f0 = 0;
214 if ( (lfrCurrentMode == LFR_MODE_BURST)
285 if ( (lfrCurrentMode == LFR_MODE_BURST)
@@ -218,18 +289,19 rtems_task avf0_task( rtems_task_argumen
218 }
289 }
219 }
290 }
220
291
221 if (nb_sm.norm_bp1_f0 == nb_sm_before_bp.norm_bp1_f0)
292 if (nb_sm.norm_bp1_f0 == nb_sm_before_f0.norm_bp1_f0)
222 {
293 {
223 nb_sm.norm_bp1_f0 = 0;
294 nb_sm.norm_bp1_f0 = 0;
224 // set another ring for the ASM storage
295 // set another ring for the ASM storage
225 current_ring_node_asm_norm_f0 = current_ring_node_asm_norm_f0->next;
296 current_ring_node_asm_norm_f0 = current_ring_node_asm_norm_f0->next;
226 if (lfrCurrentMode == LFR_MODE_NORMAL)
297 if ( (lfrCurrentMode == LFR_MODE_NORMAL)
298 || (lfrCurrentMode == LFR_MODE_SBM1) || (lfrCurrentMode == LFR_MODE_SBM2) )
227 {
299 {
228 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP1_F0;
300 msgForMATR.event = msgForMATR.event | RTEMS_EVENT_NORM_BP1_F0;
229 }
301 }
230 }
302 }
231
303
232 if (nb_sm.norm_bp2_f0 == nb_sm_before_bp.norm_bp2_f0)
304 if (nb_sm.norm_bp2_f0 == nb_sm_before_f0.norm_bp2_f0)
233 {
305 {
234 nb_sm.norm_bp2_f0 = 0;
306 nb_sm.norm_bp2_f0 = 0;
235 if ( (lfrCurrentMode == LFR_MODE_NORMAL)
307 if ( (lfrCurrentMode == LFR_MODE_NORMAL)
@@ -239,7 +311,7 rtems_task avf0_task( rtems_task_argumen
239 }