1 |
kusanagi |
1.1 |
/**************************************************************************** |
2 |
|
|
* F i l e D a t a |
3 |
|
|
* $Id: SCM_Manager_INFN.c,v 1.54 2005/03/23 10:24:12 sebastiani Exp $ |
4 |
|
|
* $Revision: 1.54 $ |
5 |
|
|
* $Date: 2005/03/23 10:24:12 $ |
6 |
|
|
* $RCSfile: SCM_Manager_INFN.c,v $ |
7 |
|
|
* |
8 |
|
|
**************************************************************************** |
9 |
|
|
* S W D e v e l o p m e n t E n v i r o n m e n t |
10 |
|
|
* |
11 |
|
|
* $Author: sebastiani $ |
12 |
|
|
* : |
13 |
|
|
**************************************************************************** |
14 |
|
|
* U p d a t i n g |
15 |
|
|
|
16 |
|
|
* $Log: SCM_Manager_INFN.c,v $ |
17 |
|
|
* Revision 1.54 2005/03/23 10:24:12 sebastiani |
18 |
|
|
* more logging in PowerOffOn |
19 |
|
|
* |
20 |
|
|
* Revision 1.53 2005/03/20 18:26:20 sebastiani |
21 |
|
|
* status = PWR_InitBoard_twice(); |
22 |
|
|
* |
23 |
|
|
* Revision 1.52 2005/03/13 18:24:47 sebastiani |
24 |
|
|
* *** empty log message *** |
25 |
|
|
* |
26 |
|
|
* Revision 1.51 2005/03/06 14:54:46 sebastiani |
27 |
|
|
* version running on 06 03 2005 |
28 |
|
|
* |
29 |
|
|
* Revision 1.50 2005/02/24 17:50:18 sebastiani |
30 |
|
|
* different PRH_VAR_POWER_MODE manages in SCM_Manager_INFN task main as a switch (2) PRH_VAR_ND_OK in custom mode get the same value as PRH_VAR_S4_OK and PRH_TAB_CONF[PRH_VAR_CONF_SEL][5] |
31 |
|
|
* |
32 |
|
|
* Revision 1.49 2005/02/21 14:26:01 sebastiani |
33 |
|
|
* TSB bugfixes. |
34 |
|
|
* |
35 |
|
|
* Revision 1.48 2005/02/21 08:58:29 sebastiani |
36 |
|
|
* all log comments completed |
37 |
|
|
* |
38 |
|
|
* Revision 1.47 2005/02/19 10:19:38 sebastiani |
39 |
|
|
* ALM_S4_CALIB_00_HARD,ALM_S4_CALIB_00_SOFT,ALM_S4_128TRIGGER_0 added |
40 |
|
|
* |
41 |
|
|
* Revision 1.46 2005/01/26 18:46:48 sebastiani |
42 |
|
|
* new bug fixes for WS |
43 |
|
|
* |
44 |
|
|
* Revision 1.45 2004/12/23 13:54:34 faber |
45 |
|
|
* PWR_HVSetting() introduced |
46 |
|
|
* |
47 |
|
|
* Revision 1.44 2004/12/20 14:02:04 faber |
48 |
|
|
* @LOG entry introduced in all ALM_WriteLog occurrences |
49 |
|
|
* |
50 |
|
|
* Revision 1.43 2004/12/15 09:32:47 sebastiani |
51 |
|
|
* invocation of PWR_TRBSetting() moved into invocation of PWR_TRB_On() |
52 |
|
|
* |
53 |
|
|
* Revision 1.42 2004/11/30 11:51:53 faber |
54 |
|
|
* AC+AC2 software moved into AC_1 AC_2 |
55 |
|
|
* new calibration and initialization for AC |
56 |
|
|
* first version,never run |
57 |
|
|
* |
58 |
|
|
* Revision 1.41 2004/11/25 09:20:17 sebastiani |
59 |
|
|
* *** empty log message *** |
60 |
|
|
* |
61 |
|
|
* Revision 1.40 2004/11/23 22:54:06 sebastiani |
62 |
|
|
* *** empty log message *** |
63 |
|
|
* |
64 |
|
|
* Revision 1.39 2004/11/19 15:14:52 sebastiani |
65 |
|
|
* PRH_EXTERN_{VAR,ARR,TABLE} removed and put them on the autogenerated parameter heeader file |
66 |
|
|
* |
67 |
|
|
* Revision 1.38 2004/11/18 16:02:34 sebastiani |
68 |
|
|
* GAS/TRD removed |
69 |
|
|
* |
70 |
|
|
* Revision 1.37 2004/11/05 09:36:35 sebastiani |
71 |
|
|
* first version of the PM state machine. tried but not deeply tested |
72 |
|
|
* |
73 |
|
|
* Revision 1.36 2004/11/02 15:41:39 faber |
74 |
|
|
* *** empty log message *** |
75 |
|
|
* |
76 |
|
|
* Revision 1.35 2004/10/22 16:05:06 sebastiani |
77 |
|
|
* *** empty log message *** |
78 |
|
|
* |
79 |
|
|
* Revision 1.34 2004/10/19 16:59:27 sebastiani |
80 |
|
|
* first text for IPM/ciclyc |
81 |
|
|
* |
82 |
|
|
* Revision 1.33 2004/10/18 10:43:02 faber |
83 |
|
|
* Power check new fligh mode |
84 |
|
|
* |
85 |
|
|
* Revision 1.32 2004/09/30 09:56:52 alfarano |
86 |
|
|
* thermistors check funcs |
87 |
|
|
* |
88 |
|
|
* Revision 1.31 2004/09/28 15:34:30 alfarano |
89 |
|
|
* *** empty log message *** |
90 |
|
|
* |
91 |
|
|
* Revision 1.30 2004/09/28 15:10:51 alfarano |
92 |
|
|
* little bug |
93 |
|
|
* |
94 |
|
|
* Revision 1.28 2004/09/27 15:42:43 alfarano |
95 |
|
|
* tracker sensor board functions |
96 |
|
|
* |
97 |
|
|
* Revision 1.27 2004/09/22 15:54:54 alfarano |
98 |
|
|
* S4 functions |
99 |
|
|
* |
100 |
|
|
* Revision 1.26 2004/09/17 15:01:00 faber |
101 |
|
|
* LU_INFN_LOG flags fixing |
102 |
|
|
* |
103 |
|
|
* Revision 1.25 2004/09/14 13:05:37 alfarano |
104 |
|
|
* update TM constants and definitions |
105 |
|
|
* |
106 |
|
|
* Revision 1.23 2004/09/10 15:27:28 sebastiani |
107 |
|
|
* added PWR dcdc procedures |
108 |
|
|
* |
109 |
|
|
* Revision 1.22 2004/08/30 07:08:18 sebastiani |
110 |
|
|
* little modify |
111 |
|
|
* |
112 |
|
|
* Revision 1.21 2004/08/27 13:13:49 alfarano |
113 |
|
|
* High voltage functions |
114 |
|
|
* |
115 |
|
|
* Revision 1.20 2004/08/26 16:54:34 sebastiani |
116 |
|
|
* version work fine |
117 |
|
|
* |
118 |
|
|
* Revision 1.19 2004/08/05 16:19:07 sebastiani |
119 |
|
|
* fix close run |
120 |
|
|
* add cal handler error |
121 |
|
|
* fix tmtc |
122 |
|
|
* ok protocol betwen pm-rm-scm |
123 |
|
|
* |
124 |
|
|
* Revision 1.18 2004/08/02 15:49:47 alfarano |
125 |
|
|
* alarm handling , scm & pm communication rewrite |
126 |
|
|
* |
127 |
|
|
* Revision 1.17 2004/08/02 12:16:06 sebastiani |
128 |
|
|
* little fix |
129 |
|
|
* |
130 |
|
|
* Revision 1.16 2004/07/27 10:13:48 faber |
131 |
|
|
* LU_ALARM macro introduced, |
132 |
|
|
* LU_XXXX bit field "logtype" redefined. |
133 |
|
|
* HistoryArea 5 now log a 32 bit word as "info1" |
134 |
|
|
* and logging is reformatted. |
135 |
|
|
* |
136 |
|
|
* Revision 1.15 2004/07/15 10:50:28 sebastiani |
137 |
|
|
* *** empty log message *** |
138 |
|
|
* |
139 |
|
|
* Revision 1.14 2004/07/13 14:35:54 alfarano |
140 |
|
|
* *** empty log message *** |
141 |
|
|
* |
142 |
|
|
* Revision 1.13 2004/07/12 09:19:33 sebastiani |
143 |
|
|
* some fixing about alamrs |
144 |
|
|
* |
145 |
|
|
* Revision 1.12 2004/06/15 08:24:37 sebastiani |
146 |
|
|
* *** empty log message *** |
147 |
|
|
* |
148 |
|
|
* Revision 1.11 2004/04/29 14:31:46 sebastiani |
149 |
|
|
* SAVETM bugfix |
150 |
|
|
* |
151 |
|
|
* Revision 1.10 2004/04/20 14:54:13 faber |
152 |
|
|
* work before Brussel |
153 |
|
|
* |
154 |
|
|
* Revision 1.9 2004/03/09 19:07:22 faber |
155 |
|
|
* introduced timer cancelling when disable sampling/storing of TMTC |
156 |
|
|
* |
157 |
|
|
* Revision 1.8 2004/03/09 15:10:29 faber |
158 |
|
|
* HK_DoCyclicAcquisition takes a void *all_values_ptr param |
159 |
|
|
* removed check cycle in the TMTC Module |
160 |
|
|
* |
161 |
|
|
* Revision 1.7 2004/03/08 15:49:09 alfarano |
162 |
|
|
* improved handling functions for FE |
163 |
|
|
* |
164 |
|
|
* Revision 1.6 2004/02/27 15:40:46 tassa |
165 |
|
|
* TMTC function moved in SCM MANAGER |
166 |
|
|
* add function blocking to send FE command in HK MANAGER |
167 |
|
|
* |
168 |
|
|
* Revision 1.5 2003/12/06 08:32:38 faber |
169 |
|
|
* startup procedure tuned. TMTC sampling storing at startup |
170 |
|
|
* |
171 |
|
|
* Revision 1.4 2003/12/05 17:14:34 alfarano |
172 |
|
|
* update |
173 |
|
|
* |
174 |
|
|
* Revision 1.3 2003/12/04 17:16:08 sebastiani |
175 |
|
|
* GS debug/tests, and other |
176 |
|
|
* |
177 |
|
|
* Revision 1.2 2003/11/27 17:53:23 faber |
178 |
|
|
* -Power management poweron procedure done and some tested in the simulator |
179 |
|
|
* -history entry 5 now takes OBT |
180 |
|
|
* |
181 |
|
|
* Revision 1.1 2003/11/19 15:47:03 faber |
182 |
|
|
* System Control Manager (SCM) and Power Handler (PWR) modules introduced |
183 |
|
|
* |
184 |
|
|
* Revision 1.1 2003/10/03 16:12:26 faber |
185 |
|
|
* *** empty log message *** |
186 |
|
|
* |
187 |
|
|
* |
188 |
|
|
*****************************************************************************/ |
189 |
|
|
|
190 |
|
|
|
191 |
|
|
|
192 |
|
|
/*============================= Include File ================================*/ |
193 |
|
|
|
194 |
|
|
#include <src/INFN/LU_SourceFileID_INFN.h> |
195 |
|
|
#define __FILEID__ _SCM_Manager_INFN__c |
196 |
|
|
#include <src/INFN/PRH_ParamHandler_INFN.h> |
197 |
|
|
#include <src/INFN/LU_LogUtility_INFN.h> |
198 |
|
|
#include <src/INFN/PRH_ParamHandler_INFN_auto.h> |
199 |
|
|
LU_DECL_MASK(); |
200 |
|
|
|
201 |
|
|
#include <src/INFN/SCM_Manager_INFN.h> |
202 |
|
|
#include <src/TM_TCManager/TMTCManager/TM_TMTCManager_op.h> |
203 |
|
|
#include <src/INFN/HK_Manager_INFN.h> |
204 |
|
|
#include <src/INFN/HB_HKBuffer_INFN.h> |
205 |
|
|
#include <src/INFN/KHB_Driver_INFN.h> |
206 |
|
|
#include <src/INFN/PWR_PowerHandler_INFN.h> |
207 |
|
|
#include <src/INFN/GS_Gas_INFN.h> |
208 |
|
|
#include <src/INFN/PM_PamManager_INFN.h> |
209 |
|
|
#include <src/INFN/MH_ModeHandler_INFN.h> |
210 |
|
|
#include <src/INFN/ALM_Alarm_INFN.h> |
211 |
|
|
#include <src/INFN/TRK_Tracker_INFN.h> |
212 |
|
|
#include <src/INFN/OS_rtems_INFN_p.h> |
213 |
|
|
|
214 |
|
|
|
215 |
|
|
#define SCM_IPM_CHECK(var,ipm) (var & (1 << ipm)) |
216 |
|
|
|
217 |
|
|
|
218 |
|
|
//static BOOL SCM_Therm_Alarm,SCM_Pamela_OffOn,SCM_Pamela_OnOff,SCM_IPM_Alarm,SCM_Switch_OffAll,SCM_KHB_Alarm,SCM_IDAQ_Alarm; |
219 |
|
|
|
220 |
|
|
static UINT32 SCM_TMValues[TM_MAX_TELEMETRY]; |
221 |
|
|
|
222 |
|
|
#define SCM_SAMPLED 30 |
223 |
|
|
#define SCM_SAMPLE_UNDEFINED 0xFFFFFFFF |
224 |
|
|
static UINT32 SCM_SampleTMValues_Index; |
225 |
|
|
static UINT32 SCM_SampleTMVAlues[SCM_SAMPLED][TM_MAX_TELEMETRY]; |
226 |
|
|
static UINT32 SCM_SampleAverage[TM_MAX_TELEMETRY]; |
227 |
|
|
static UINT32 SCM_TM_Reference[TM_MAX_TELEMETRY]; |
228 |
|
|
static UINT16 SCM_TM_Therm_Count[TM_THERMISTOR_COUNT]; |
229 |
|
|
static BOOL SCM_SampleIsFull; |
230 |
|
|
static BOOL SCM_EnableCyclicCheck; |
231 |
|
|
static BOOL SCM_do_skip_detectors; |
232 |
|
|
static UINT32 SCM_count_failed_power_on=0; |
233 |
|
|
static UINT32 SCM_pamela_switched_off_therm=0; |
234 |
|
|
|
235 |
|
|
/* task status: */ |
236 |
|
|
SCM_ACTION SCM_Action=SCM_NO_ACTION; |
237 |
|
|
/*****************************************************************************/ |
238 |
|
|
/*============================= Object variables ============================*/ |
239 |
|
|
|
240 |
|
|
|
241 |
|
|
/*****************************************************************************/ |
242 |
|
|
|
243 |
|
|
/* P a y l o a d s O P E R A T I O N A L F U N C T I O N S */ |
244 |
|
|
|
245 |
|
|
/*****************************************************************************/ |
246 |
|
|
/* @Function: SCM_InitHKManager */ |
247 |
|
|
/* @Purpose : */ |
248 |
|
|
/* Initialialization function of the HK component. */ |
249 |
|
|
/* */ |
250 |
|
|
/* @@ */ |
251 |
|
|
/* @Parameter Name @Mode @Description */ |
252 |
|
|
/* status_code OUT Return code */ |
253 |
|
|
/* @@ */ |
254 |
|
|
/*****************************************************************************/ |
255 |
|
|
|
256 |
|
|
status_code SCM_InitSCManager (void) |
257 |
|
|
{ |
258 |
|
|
status_code status; |
259 |
|
|
void * p; |
260 |
|
|
unsigned short * pR; |
261 |
|
|
unsigned int OldPriority; |
262 |
|
|
|
263 |
|
|
// Task initialization |
264 |
|
|
|
265 |
|
|
if ((status=OS_piTaskReady_INFN(SCM_INFN_TASK,SCM_tkSCManager)) != SUCCESSFUL) |
266 |
|
|
{ |
267 |
|
|
/*@LOG Task is not correctly started - status */ |
268 |
|
|
LU_INFN_LOG (LU_FATAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
269 |
|
|
status = UNSATISFIED; |
270 |
|
|
} |
271 |
|
|
|
272 |
|
|
if ( (status=OS_piTaskPriority_INFN(SCM_INFN_TASK, SCM_MANAGER_PRIORITY, &OldPriority)) != SUCCESSFUL) |
273 |
|
|
{ |
274 |
|
|
/*@LOG Task priority is not correctly updated - status */ |
275 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
276 |
|
|
status = UNSATISFIED; |
277 |
|
|
} |
278 |
|
|
SCM_InitSampledValues(); |
279 |
|
|
SCM_do_skip_detectors=0; |
280 |
|
|
SCM_count_failed_power_on=0; |
281 |
|
|
return (status); |
282 |
|
|
} |
283 |
|
|
|
284 |
|
|
|
285 |
|
|
status_code SCM_SendCode(SCM_ACTION action) { |
286 |
|
|
MsgTsk SndMsg; |
287 |
|
|
SndMsg.Code = action; |
288 |
|
|
return SCM_SndMsgSCManager(&SndMsg); |
289 |
|
|
} |
290 |
|
|
|
291 |
|
|
|
292 |
|
|
status_code SCM_SndMsgSCManager(MsgTsk* SndMsg) |
293 |
|
|
{ |
294 |
|
|
status_code status; |
295 |
|
|
status = OS_piMsgQueueSend_INFN(SCM_INFN_MAILBOX, (void *) SndMsg, sizeof(MsgTsk)); |
296 |
|
|
if(status != SUCCESSFUL) |
297 |
|
|
/*@LOG Failed sending message to SCM - status */ |
298 |
|
|
LU_INFN_LOG (LU_FATAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
299 |
|
|
return (status); |
300 |
|
|
} |
301 |
|
|
|
302 |
|
|
|
303 |
|
|
void SCM_SetCyclicCheck(BOOL b) { |
304 |
|
|
SCM_EnableCyclicCheck=b; |
305 |
|
|
} |
306 |
|
|
|
307 |
|
|
SCM_ACTION SCM_GetCurrentAction() { |
308 |
|
|
UINT32 level; |
309 |
|
|
SCM_ACTION action; |
310 |
|
|
OS_PROTECTED_INT(level,action=SCM_Action); |
311 |
|
|
return action; |
312 |
|
|
} |
313 |
|
|
|
314 |
|
|
|
315 |
|
|
task SCM_tkSCManager (task_argument unused) |
316 |
|
|
{ |
317 |
|
|
status_code status; |
318 |
|
|
MsgTsk RxMsg,SndMsg; |
319 |
|
|
unsigned int MsgSize; |
320 |
|
|
unsigned int no_cyclic=0; |
321 |
|
|
UINT32 level; |
322 |
|
|
|
323 |
|
|
while (FOREVER) |
324 |
|
|
{ |
325 |
|
|
if ((status = OS_piMsgQueueReceive_INFN(SCM_INFN_MAILBOX,(void *)&RxMsg,&MsgSize,WAIT,NO_TIMEOUT)) == SUCCESSFUL) { |
326 |
|
|
OS_PROTECTED_INT(level,SCM_Action=(SCM_ACTION)RxMsg.Code); |
327 |
|
|
switch (SCM_Action) { |
328 |
|
|
case SCM_SAVE_TMTC_VALUES: |
329 |
|
|
status = HK_SaveTMTCValues(); |
330 |
|
|
if (status != CM_RC_SUCCESSFUL) |
331 |
|
|
/*@LOG Error saving TMTC Values - status */ |
332 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
333 |
|
|
break; |
334 |
|
|
case SCM_CYCLIC_ACQUISITION: |
335 |
|
|
|
336 |
|
|
/* |
337 |
|
|
if(RxMsg.Info[0]) |
338 |
|
|
{ |
339 |
|
|
SCM_InitSampledValues(); |
340 |
|
|
no_cyclic=0; |
341 |
|
|
} |
342 |
|
|
*/ |
343 |
|
|
no_cyclic++; |
344 |
|
|
status = HK_DoCyclicAcquisition((void*)SCM_TMValues); |
345 |
|
|
if(status != CM_RC_SUCCESSFUL) |
346 |
|
|
status = CM_RC_DO_STOP_WAIT; |
347 |
|
|
else { |
348 |
|
|
SCM_StoreSampledTMValues(); |
349 |
|
|
|
350 |
|
|
if(PRH_VAR_SCM_TM_DO_CHECK_VALUES_FREQ && |
351 |
|
|
no_cyclic >= PRH_VAR_SCM_TM_DO_CHECK_VALUES_FREQ && |
352 |
|
|
SCM_EnableCyclicCheck) |
353 |
|
|
{ |
354 |
|
|
status = SCM_CyclicChecks(); |
355 |
|
|
if(status) |
356 |
|
|
/*@LOG SCM_CyclicChecks return unsuccessfull - status */ |
357 |
|
|
LU_INFN_LOG (LU_DEBUG_TRACE|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
358 |
|
|
no_cyclic=0; |
359 |
|
|
} |
360 |
|
|
} |
361 |
|
|
break; |
362 |
|
|
case SCM_POWER_ON: |
363 |
|
|
{ |
364 |
|
|
|
365 |
|
|
PRH_VAR_PAMELA_ON = 0; |
366 |
|
|
SCM_pamela_switched_off_therm=0; |
367 |
|
|
|
368 |
|
|
PWR_IPM_WaitOK(); |
369 |
|
|
status = PWR_PowerCheck(TRUE); |
370 |
|
|
/*@LOG SCM_POWER_ON : PWR_PowerCheck(TRUE) - status */ |
371 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
372 |
|
|
|
373 |
|
|
if (status) |
374 |
|
|
{ |
375 |
|
|
// status==CM_RC_DO_STOP_WAIT and called dcdcOFF(true) |
376 |
|
|
status = CM_RC_DO_STOP_WAIT; |
377 |
|
|
} |
378 |
|
|
else |
379 |
|
|
{ |
380 |
|
|
status = PWR_DcdcON(); |
381 |
|
|
/*@LOG SCM_POWER_ON: PWR_DcdcON - status */ |
382 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
383 |
|
|
|
384 |
|
|
if (status == CM_RC_SUCCESSFUL) |
385 |
|
|
{ |
386 |
|
|
PRH_VAR_N_CALIB = 0; |
387 |
|
|
PRH_VAR_PAMELA_ON = 1; |
388 |
|
|
|
389 |
|
|
if(PRH_VAR_TRB_OK) { |
390 |
|
|
status = PWR_TRB_On(); |
391 |
|
|
/*@LOG SCM_POWER_ON: PWR_TRB_On(); - status */ |
392 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
393 |
|
|
} |
394 |
|
|
|
395 |
|
|
if(status == CM_RC_SUCCESSFUL/**/){ |
396 |
|
|
if(PRH_ARR_TSB_BOARD_OK[0] || PRH_ARR_TSB_BOARD_OK[1]) { |
397 |
|
|
status = PWR_CMD2PSB(PRH_ARR_PSB_COMMANDS[PWR_PSB_TRACKER_SENSOR_ON],TM_PSB_ALARM,CM_OFF, |
398 |
|
|
ALM_TRK_TRKSNS_1,ALM_TRK_TRKSNS_2,PWR_PSB_STANDARD_ANSWER); |
399 |
|
|
if(status) |
400 |
|
|
/*@LOG SCM_POWER_ON: TSB Switch on error - status */ |
401 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
402 |
|
|
else |
403 |
|
|
OS_piTaskSuspend(TRK_SENSORS_WAIT); |
404 |
|
|
|
405 |
|
|
status = PWR_InitBoard_twice(); |
406 |
|
|
if(status != CM_RC_SUCCESSFUL){ |
407 |
|
|
/*@LOG PWR_DcdcON - KHB INIT BOARD at end of function: - status */ |
408 |
|
|
LU_INFN_LOG(LU_DEBUG_TRACE|LU_HA,LU_MASK(__FILEID__),__FILEID__,__LINE__,status); |
409 |
|
|
status=CM_RC_DO_POWER_OFF_ON; |
410 |
|
|
} |
411 |
|
|
} |
412 |
|
|
|
413 |
|
|
if(status==CM_RC_SUCCESSFUL && PRH_VAR_HV_OK) { |
414 |
|
|
status = PWR_HVSetting(); |
415 |
|
|
/*@LOG SCM_POWER_ON: PWR_HVSetting() - status */ |
416 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
417 |
|
|
} |
418 |
|
|
|
419 |
|
|
if(status == CM_RC_SUCCESSFUL) |
420 |
|
|
switch(PRH_VAR_PULSER_ACTION) { |
421 |
|
|
case 1: |
422 |
|
|
status=PWR_SendTC(TM_PULSER_RESET); |
423 |
|
|
/*@LOG SCM_POWER_ON: Reset Pulser - status */ |
424 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,status); |
425 |
|
|
break; |
426 |
|
|
case 2: |
427 |
|
|
status=PWR_SendTC(TM_PULSER_025); |
428 |
|
|
/*@LOG SCM_POWER_ON: Set Pulser 0.25 - status */ |
429 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,status); |
430 |
|
|
break; |
431 |
|
|
case 3: |
432 |
|
|
status=PWR_SendTC(TM_PULSER_100); |
433 |
|
|
/*@LOG SCM_POWER_ON: Set Pulser 100 - status */ |
434 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,status); |
435 |
|
|
break; |
436 |
|
|
} |
437 |
|
|
} |
438 |
|
|
else |
439 |
|
|
status=CM_RC_DO_POWER_OFF_ON; |
440 |
|
|
} |
441 |
|
|
else{ // CM_RC_DO_POWER_OFF_ON; |
442 |
|
|
/*@LOG PWR_DcdcON returns unsuccessfull: goto CM_RC_DO_POWER_OFF_ON */ |
443 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
444 |
|
|
} |
445 |
|
|
} |
446 |
|
|
/* if startup terminates with CM_RC_DO_POWER_OFF_ON, is not usefull to skip detectors in |
447 |
|
|
SCM_PowerOffOn() */ |
448 |
|
|
SCM_do_skip_detectors=(status!=CM_RC_DO_POWER_OFF_ON); |
449 |
|
|
if(status==CM_RC_SUCCESSFUL) |
450 |
|
|
SCM_count_failed_power_on=0; |
451 |
|
|
} |
452 |
|
|
break; |
453 |
|
|
case SCM_POWEROFF_ON: |
454 |
|
|
status = SCM_PowerOffOn(); |
455 |
|
|
break; |
456 |
|
|
case SCM_POWEROFFSHUTDOWN: |
457 |
|
|
PWR_DcdcOFF(TRUE); |
458 |
|
|
status = CM_RC_SUCCESSFUL; |
459 |
|
|
break; |
460 |
|
|
case SCM_POWEROFF: |
461 |
|
|
PWR_DcdcOFF(FALSE); |
462 |
|
|
status = CM_RC_SUCCESSFUL; |
463 |
|
|
break; |
464 |
|
|
case SCM_TSB_T_CHECK: |
465 |
|
|
if(PRH_VAR_TSB_T_OK) |
466 |
|
|
status = TRK_CheckTSensors(); |
467 |
|
|
else |
468 |
|
|
status = CM_RC_SUCCESSFUL; |
469 |
|
|
if(status != CM_RC_SUCCESSFUL) { |
470 |
|
|
/*@LOG SCM_TSB_T_CHECK error : - status */ |
471 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
472 |
|
|
status = CM_RC_DO_POWER_OFF_ON; |
473 |
|
|
} |
474 |
|
|
break; |
475 |
|
|
case SCM_TSB_B_CHECK: |
476 |
|
|
if(PRH_VAR_TSB_B_OK) |
477 |
|
|
status = TRK_CheckBSensors(); |
478 |
|
|
else |
479 |
|
|
status = CM_RC_SUCCESSFUL; |
480 |
|
|
if(status != CM_RC_SUCCESSFUL) { |
481 |
|
|
/*@LOG SCM_TSB_B_CHECK error : - status */ |
482 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
483 |
|
|
status = CM_RC_DO_POWER_OFF_ON; |
484 |
|
|
} |
485 |
|
|
break; |
486 |
|
|
default: |
487 |
|
|
/*@LOG SCM error operation code - status */ |
488 |
|
|
LU_INFN_LOG (LU_INTERNAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__, status); |
489 |
|
|
break; |
490 |
|
|
} |
491 |
|
|
SCM_BC2PM((SCM_ACTION)RxMsg.Code,status); |
492 |
|
|
OS_PROTECTED_INT(level,SCM_Action = SCM_NO_ACTION); |
493 |
|
|
} |
494 |
|
|
} |
495 |
|
|
} |
496 |
|
|
|
497 |
|
|
|
498 |
|
|
status_code SCM_InitSampledValues() { |
499 |
|
|
int i,j; |
500 |
|
|
SCM_SampleTMValues_Index=0; |
501 |
|
|
SCM_SampleIsFull = FALSE; |
502 |
|
|
|
503 |
|
|
for(i=0;i<SCM_SAMPLED;i++) |
504 |
|
|
for(j=0;j<TM_MAX_TELEMETRY;j++) |
505 |
|
|
SCM_SampleTMVAlues[i][j]=SCM_SAMPLE_UNDEFINED; |
506 |
|
|
|
507 |
|
|
for(i=0; i < TM_THERMISTOR_COUNT; i++) |
508 |
|
|
SCM_TM_Therm_Count[i]=0; |
509 |
|
|
|
510 |
|
|
} |
511 |
|
|
|
512 |
|
|
status_code SCM_StoreSampledTMValues() |
513 |
|
|
{ |
514 |
|
|
int i,j; |
515 |
|
|
unsigned int loc_mask; |
516 |
|
|
|
517 |
|
|
if(SCM_SampleTMValues_Index >= SCM_SAMPLED) |
518 |
|
|
{ |
519 |
|
|
SCM_SampleIsFull = TRUE; |
520 |
|
|
SCM_SampleTMValues_Index=0; |
521 |
|
|
} |
522 |
|
|
|
523 |
|
|
memcpy(SCM_SampleTMVAlues[SCM_SampleTMValues_Index], |
524 |
|
|
SCM_TMValues, |
525 |
|
|
sizeof(SCM_TMValues)); |
526 |
|
|
|
527 |
|
|
SCM_SampleTMValues_Index++; |
528 |
|
|
|
529 |
|
|
return(CM_RC_SUCCESSFUL); |
530 |
|
|
} |
531 |
|
|
|
532 |
|
|
|
533 |
|
|
status_code SCM_ComputeSampleAverage() |
534 |
|
|
{ |
535 |
|
|
status_code status=CM_RC_SUCCESSFUL; |
536 |
|
|
UINT32 i,j; |
537 |
|
|
BOOL termfault=FALSE; |
538 |
|
|
if(SCM_SampleIsFull == TRUE) { |
539 |
|
|
|
540 |
|
|
/* TH_ANA: */ |
541 |
|
|
for(j=TM_TH_ANA_1;j<=TM_TH_ANA_16;j++) { |
542 |
|
|
SCM_SampleAverage[j]=0; |
543 |
|
|
termfault=FALSE; |
544 |
|
|
for(i=0;i<SCM_SAMPLED && !termfault; i++){ |
545 |
|
|
if(SCM_SampleTMVAlues[i][j] >= SCM_THERM_FAULTVALUE) |
546 |
|
|
termfault=TRUE; |
547 |
|
|
SCM_SampleAverage[j]+=SCM_SampleTMVAlues[i][j]; |
548 |
|
|
} |
549 |
|
|
if(termfault) |
550 |
|
|
SCM_SampleAverage[j]=SCM_THERM_FAULTVALUE; |
551 |
|
|
else |
552 |
|
|
SCM_SampleAverage[j]/=SCM_SAMPLED; |
553 |
|
|
} |
554 |
|
|
} |
555 |
|
|
else |
556 |
|
|
status=CM_RC_NOINFO; |
557 |
|
|
|
558 |
|
|
return status; |
559 |
|
|
} |
560 |
|
|
|
561 |
|
|
status_code SCM_TM_Thermistors_Check() |
562 |
|
|
{ |
563 |
|
|
status_code status = CM_RC_SUCCESSFUL; |
564 |
|
|
int i,j,loc_mask; |
565 |
|
|
BOOL can_switch = TRUE; |
566 |
|
|
|
567 |
|
|
for(j=TM_TH_ANA_1,loc_mask=1;j <= TM_TH_ANA_16;j++,loc_mask<<=1) |
568 |
|
|
{ |
569 |
|
|
if ( (loc_mask & PRH_VAR_THERM_MASK) && SCM_SampleAverage[j]!= SCM_THERM_FAULTVALUE) |
570 |
|
|
{ |
571 |
|
|
if (SCM_SampleAverage[j] < PRH_ARR_THERM_LOW[j-TM_TH_ANA_1]) // too high temperature |
572 |
|
|
{ |
573 |
|
|
/*@LOG TM_Thermistors_Check() : temperature too high ! */ |
574 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,j); |
575 |
|
|
/*@LOG TM_Thermistors_Check() : temperature too high ! */ |
576 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,SCM_SampleAverage[j]); |
577 |
|
|
if(PRH_VAR_PAMELA_ON) { |
578 |
|
|
SCM_pamela_switched_off_therm++; |
579 |
|
|
return CM_RC_DO_STOP_WAIT; // some temperature is too high and pamela is on: swith off |
580 |
|
|
} |
581 |
|
|
else |
582 |
|
|
return CM_RC_SUCCESSFUL; // some tempetarure is too high but pamela already off: do nothing |
583 |
|
|
} |
584 |
|
|
if (SCM_SampleAverage[j] < PRH_ARR_THERM_HIGH[j-TM_TH_ANA_1]) // some temperature still not in the range |
585 |
|
|
can_switch = FALSE; |
586 |
|
|
} |
587 |
|
|
} |
588 |
|
|
|
589 |
|
|
if (PRH_VAR_PAMELA_ON == 0 && can_switch && SCM_pamela_switched_off_therm) |
590 |
|
|
{ |
591 |
|
|
|
592 |
|
|
/* |
593 |
|
|
All temperatures are fine we can power on and last pamela_swith off was because therm. |
594 |
|
|
PAMELA can be switched on if and only if the last power off was due a temperature too high. |
595 |
|
|
if PAMELA had been swithed on because of some other reason, SCM_pamela_switched_off_therm is zeroed. |
596 |
|
|
*/ |
597 |
|
|
|
598 |
|
|
/*@LOG TM_Thermistors_Check() : all temperature go back to granted values: switch on pamela! */ |
599 |
|
|
LU_INFN_LOG (LU_WARNING|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,0xBE11E); |
600 |
|
|
status=CM_RC_DO_POWER_ON; |
601 |
|
|
} |
602 |
|
|
return status; |
603 |
|
|
} |
604 |
|
|
|
605 |
|
|
status_code SCM_IPM_Voltages_Check() |
606 |
|
|
{ |
607 |
|
|
return PWR_PowerCheck(FALSE); |
608 |
|
|
} |
609 |
|
|
|
610 |
|
|
status_code SCM_KHB_IDAQ_Error_Check() |
611 |
|
|
{ |
612 |
|
|
unsigned int idaqcc=0,khbcc=0; |
613 |
|
|
status_code s; |
614 |
|
|
CM_HOT_COLD hc; |
615 |
|
|
|
616 |
|
|
s = HK_KHB_GetHotCold(&hc); |
617 |
|
|
if(s == CM_RC_SUCCESSFUL){ |
618 |
|
|
if(hc==CM_HOT){ |
619 |
|
|
idaqcc = SCM_TMValues[TM_IDAQ_HOT_ALARM]; |
620 |
|
|
khbcc = SCM_TMValues[TM_KHB_HOT_LATCHUP]; |
621 |
|
|
} |
622 |
|
|
else{ |
623 |
|
|
idaqcc = SCM_TMValues[TM_IDAQ_COLD_ALARM]; |
624 |
|
|
khbcc = SCM_TMValues[TM_KHB_COLD_LATCHUP]; |
625 |
|
|
} |
626 |
|
|
} |
627 |
|
|
if(s!=CM_RC_SUCCESSFUL){ |
628 |
|
|
/*@LOG Idaq Error Check: error retriving HOT/COLD status. Bug!! - status */ |
629 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,s); |
630 |
|
|
return CM_RC_DO_POWER_OFF_ON;// ?? |
631 |
|
|
} |
632 |
|
|
if(khbcc) |
633 |
|
|
{ |
634 |
|
|
/*@LOG khbcc not zero goto POWER_OFF_ON - khbcc */ |
635 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,khbcc); |
636 |
|
|
return CM_RC_DO_POWER_OFF_ON; |
637 |
|
|
} |
638 |
|
|
if(idaqcc) |
639 |
|
|
{ |
640 |
|
|
/*@LOG idaqcc not zero goto POWER_OFF_ON - idaqcc */ |
641 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,idaqcc); |
642 |
|
|
return CM_RC_DO_POWER_OFF_ON; |
643 |
|
|
} |
644 |
|
|
return CM_RC_SUCCESSFUL; |
645 |
|
|
} |
646 |
|
|
|
647 |
|
|
status_code SCM_PowerOffOn() |
648 |
|
|
{ |
649 |
|
|
status_code status; |
650 |
|
|
|
651 |
|
|
if (PRH_VAR_OFF < PRH_VAR_NOFF) |
652 |
|
|
{ |
653 |
|
|
PRH_VAR_OFF++; |
654 |
|
|
|
655 |
|
|
/*@LOG PowerOffOn: number of switched off - PRH_VAR_OFF */ |
656 |
|
|
ALM_WriteLog(ALM_OFF,PRH_VAR_OFF); |
657 |
|
|
/*@LOG PowerOffOn: number of reset - PRH_VAR_RES */ |
658 |
|
|
ALM_WriteLog(ALM_RES,PRH_VAR_RES); |
659 |
|
|
PWR_DcdcOFF(FALSE); |
660 |
|
|
status = CM_RC_DO_POWER_ON; |
661 |
|
|
} |
662 |
|
|
else |
663 |
|
|
{ |
664 |
|
|
|
665 |
|
|
/*@LOG PowerOffOn: number of switched off (PRH_VAR_OFF) exceedes NOFF (PRH_VAR_NOFF) - PRH_VAR_OFF */ |
666 |
|
|
LU_INFN_LOG (LU_WARNING|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,PRH_VAR_OFF); |
667 |
|
|
|
668 |
|
|
switch(PRH_VAR_POWER_MODE) { |
669 |
|
|
case 1: |
670 |
|
|
case 2: |
671 |
|
|
PRH_VAR_POWER_MODE++; |
672 |
|
|
PWR_DcdcOFF(FALSE); |
673 |
|
|
status = CM_RC_DO_POWER_ON; |
674 |
|
|
break; |
675 |
|
|
case 3: |
676 |
|
|
{ |
677 |
|
|
|
678 |
|
|
PWR_DcdcOFF(FALSE); |
679 |
|
|
status = CM_RC_DO_POWER_ON; |
680 |
|
|
|
681 |
|
|
|
682 |
|
|
if(!SCM_do_skip_detectors) { |
683 |
|
|
if(SCM_count_failed_power_on++ > PRH_VAR_NFAILED_POWER_ON) { |
684 |
|
|
/* if numerb of failed pwoer_on > PRH_VAR_NFAILED_POWER_ON, do nothing and STOP&WAIT */ |
685 |
|
|
|
686 |
|
|
/*@LOG PowerOffOn: maximum number of power off/on - SCM_count_failed_power_on */ |
687 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,SCM_count_failed_power_on); |
688 |
|
|
|
689 |
|
|
status = CM_RC_DO_STOP_WAIT; |
690 |
|
|
return status; |
691 |
|
|
} |
692 |
|
|
} |
693 |
|
|
else{ |
694 |
|
|
if (PRH_VAR_CONFOK < 2) |
695 |
|
|
{ |
696 |
|
|
if(PRH_VAR_CONF_SEL < 5) { |
697 |
|
|
|
698 |
|
|
/*@LOG PowerOffOn: remove some FE - PRH_VAR_CONF_SEL */ |
699 |
|
|
LU_INFN_LOG (LU_CRITICAL|LU_HA, LU_MASK(__FILEID__), __FILEID__, __LINE__,PRH_VAR_CONF_SEL); |
700 |
|
|
|
701 |
|
|
PRH_VAR_CAL_OK = PRH_TAB_CONF[PRH_VAR_CONF_SEL][0]; |
702 |
|
|
PRH_VAR_TRK_OK = PRH_TAB_CONF[PRH_VAR_CONF_SEL][1]; |
703 |
|
|
PRH_VAR_TOF_OK = PRH_TAB_CONF[PRH_VAR_CONF_SEL][2]; |
704 |
|
|
PRH_VAR_AC_1_OK = PRH_TAB_CONF[PRH_VAR_CONF_SEL][3]; |
705 |
|
|
PRH_VAR_AC_2_OK = PRH_TAB_CONF[PRH_VAR_CONF_SEL][4]; |
706 |
|
|
PRH_VAR_ND_OK = PRH_VAR_S4_OK = PRH_TAB_CONF[PRH_VAR_CONF_SEL][5]; |
707 |
|
|
|
708 |
|
|
if (PRH_VAR_CONFOK == 1) |
709 |
|
|
PRH_VAR_CONF_SEL++; |
710 |
|
|
|
711 |
|
|
}else{ |
712 |
|
|
status = CM_RC_DO_STOP_WAIT; |
713 |
|
|
} |
714 |
|
|
/*@LOG PowerOffOn: PRH_VAR_CONFOK < 2 */ |
715 |
|
|
ALM_WriteLog(ALM_CONFOK,PRH_VAR_CONFOK); |
716 |
|
|
/*@LOG PowerOffOn: PRH_VAR_CONFOK < 2 */ |
717 |
|
|
ALM_WriteLog(ALM_CONF,PRH_VAR_CONF_SEL); |
718 |
|
|
PRH_VAR_OFF = 0; |
719 |
|
|
PRH_VAR_RES = 0; |
720 |
|
|
} |
721 |
|
|
} |
722 |
|
|
} |
723 |
|
|
} |
724 |
|
|
} |
725 |
|
|
return status; |
726 |
|
|
} |
727 |
|
|
|
728 |
|
|
|
729 |
|
|
status_code SCM_BC2PM(SCM_ACTION opcode,status_code code) |
730 |
|
|
{ |
731 |
|
|
status_code status; |
732 |
|
|
MsgTsk SndMsg; |
733 |
|
|
unsigned char *pc; |
734 |
|
|
|
735 |
|
|
SndMsg.Code = PM_INFN_SCMMANAGER_MSG; |
736 |
|
|
|
737 |
|
|
pc = SndMsg.Info; |
738 |
|
|
*(SCM_ACTION*)pc = opcode; pc += sizeof(SCM_ACTION); |
739 |
|
|
*(status_code*)pc = code; //pc += sizeof(status_code); |
740 |
|
|
|
741 |
|
|
SndMsg.LlInfo = sizeof(SCM_ACTION) + sizeof(status_code); |
742 |
|
|
|
743 |
|
|
status=PM_SndMsgPamManager_INFN(&SndMsg); |
744 |
|
|
return status; |
745 |
|
|
} |
746 |
|
|
|
747 |
|
|
status_code SCM_CyclicChecks() |
748 |
|
|
{ |
749 |
|
|
status_code status=CM_RC_SUCCESSFUL,ret=CM_RC_SUCCESSFUL; |
750 |
|
|
BOOL go_on; |
751 |
|
|
unsigned int ipm; |
752 |
|
|
|
753 |
|
|
|
754 |
|
|
if(SCM_ComputeSampleAverage() == CM_RC_SUCCESSFUL) |
755 |
|
|
if (PRH_VAR_THERMISTORS_CHECK) { |
756 |
|
|
status = SCM_TM_Thermistors_Check(); |
757 |
|
|
if(status != CM_RC_SUCCESSFUL) { |
758 |
|
|
return status; |
759 |
|
|
} |
760 |
|
|
} |
761 |
|
|
|
762 |
|
|
if (PRH_VAR_PAMELA_ON) |
763 |
|
|
{ |
764 |
|
|
if (PRH_VAR_IPM_VOLTAGES_CHECK) |
765 |
|
|
status = SCM_IPM_Voltages_Check(); |
766 |
|
|
|
767 |
|
|
if(status != CM_RC_SUCCESSFUL) |
768 |
|
|
return CM_RC_DO_POWER_OFF_ON; |
769 |
|
|
|
770 |
|
|
if (PRH_VAR_KHB_IDAQ_CHECK) |
771 |
|
|
return SCM_KHB_IDAQ_Error_Check(); |
772 |
|
|
|
773 |
|
|
} |
774 |
|
|
return CM_RC_SUCCESSFUL; |
775 |
|
|
} |