2
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
3 | File: vsi_com.c
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
4 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
5 | Copyright 2002 Texas Instruments Berlin, AG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
6 | All rights reserved.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
7 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
8 | This file is confidential and a trade secret of Texas
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
9 | Instruments Berlin, AG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
10 | The receipt of or possession of this file does not convey
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
11 | any rights to reproduce or disclose its contents or to
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
12 | manufacture, use, or sell anything it may describe, in
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
13 | whole, or in part, without the specific written consent of
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
14 | Texas Instruments Berlin, AG.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
15 +-----------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
16 | Purpose : This Module defines the virtual system interface part
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
17 | about communication via primitives and signals.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
18 +-----------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
19 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
20
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
21 #undef TEST_PCHECK
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
22
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
23 #ifndef __VSI_COM_C__
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
24 #define __VSI_COM_C__
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
25 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
26
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
27 /*==== INCLUDES ===================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
28
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
29 #include "typedefs.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
30 #include "string.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
31 #include "os.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
32 #include "vsi.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
33 #include "frame.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
34 #include "vsi.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
35 #include "frm_defs.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
36 #include "frm_types.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
37 #include "frm_glob.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
38 #include "route.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
39
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
40 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
41 #include "tools.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
42 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
43
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
44 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
45 #include "stdlib.h"
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
46 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
47
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
48 /*==== CONSTANTS ==================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
49
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
50 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
51 char const *waited_queue_str= "Waited for space in queue";
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
52 char const *freed_sent_str = "Freed partition sent";
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
53 char const *disc_str = "Signal discarded";
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
54 char const *freed_str = "Partition already freed";
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
55 char const *trunc_str = "Allocation request truncated";
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
56 char const *guard_str = "Partition guard pattern destroyed";
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
57 char const *unknown_str = "unknown";
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
58 #else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
59 extern char const *waited_queue_str;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
60 extern char const *freed_sent_str;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
61 extern char const *disc_str;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
62 extern char const *freed_str;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
63 extern char const *trunc_str;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
64 extern char const *guard_str;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
65 extern char const *unknown_str;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
66 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
67
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
68 #if !defined _TARGET_ && !defined _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
69 char const *pcheck_str = "pcon_check() returned error";
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
70 #define PCHECK_INITIALIZED 0xaffedead
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
71 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
72
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
73
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
74 #define MAX_DRP_BOUND 12
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
75
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
76 /*==== TYPES ======================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
77
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
78 #if !defined _TARGET_ && !defined _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
79 typedef struct
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
80 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
81 unsigned int magic_nr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
82 ULONG ret_ok;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
83 ULONG (*pcheck)(ULONG opc, void * decoded_prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
84 } T_PCHECK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
85 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
86
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
87 /*==== EXTERNALS ==================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
88
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
89 /* -------------- S H A R E D - BEGIN ---------------- */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
90 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
91 #pragma data_seg("FRAME_SHARED")
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
92 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
93
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
94
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
95 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
96 extern char FRM_TST_NAME[];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
97 __declspec (dllimport) T_HANDLE TST_Handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
98 #else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
99 extern T_HANDLE TST_Handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
100 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
101
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
102 extern T_HANDLE vsi_m_sem_handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
103 extern char TaskName [];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
104 //extern OS_HANDLE ext_data_pool_handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
105 #if defined _NUCLEUS_ && defined NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
106 extern char check_desclist;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
107 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
108
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
109 /*==== VARIABLES ==================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
110
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
111 #if !defined _TARGET_ && !defined _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
112 T_PCHECK pcheck_func;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
113 #endif /* _TARGET_ */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
114
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
115 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
116 char QueueName [ RESOURCE_NAMELEN ];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
117 //char *pf_com_matrix = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
118 #else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
119 extern char QueueName [];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
120 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
121
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
122 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
123 #pragma data_seg()
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
124 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
125 /* -------------- S H A R E D - END ---------------- */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
126
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
127 /*==== PROTOTYPES =================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
128
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
129 #if !defined _TARGET_ && !defined _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
130 #ifdef TEST_PCHECK
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
131 ULONG test_pcheck ( ULONG opc, void * decoded_prim );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
132 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
133 #endif /* _TARGET_ */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
134
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
135
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
136 #if defined _NUCLEUS_ && defined NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
137 int check_descriptor_list ( T_HANDLE caller, T_PRIM_HEADER *prim FILE_LINE_TYPE );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
138 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
139
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
140 int int_vsi_c_pattach (T_VOID_STRUCT *prim FILE_LINE_TYPE);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
141
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
142
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
143 /*==== FUNCTIONS ==================================================*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
144
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
145 #if 0
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
146 not needed -> temporarily removed
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
147 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
148 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
149 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
150 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
151 | STATE : code ROUTINE : vsi_c_open |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
152 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
153
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
154 PURPOSE : get the handle of a queue
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
155
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
156 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
157
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
158 char * vsi_c_init_com_matrix ( int max_entities )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
159 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
160 int size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
161
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
162 size = (max_entities+1)*(max_entities+1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
163 if ( os_AllocateMemory ( NO_TASK, (T_VOID_STRUCT**)&pf_com_matrix, size, OS_NO_SUSPEND, ext_data_pool_handle ) != OS_OK )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
164 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
165 vsi_o_assert ( NO_TASK, OS_SYST_ERR_NO_MEMORY, __FILE__, __LINE__, "No memory available for com matrix");
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
166 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
167 return pf_com_matrix;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
168 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
169 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
170
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
171
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
172 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
173 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
174 +--------------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
175 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
176 | STATE : code ROUTINE : vsi_c_get_com_matrix_entry|
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
177 +--------------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
178
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
179 PURPOSE : get an entry of the com matrix
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
180
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
181 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
182
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
183 int vsi_c_get_com_matrix_entry ( int entry, char *dst )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
184 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
185 T_HANDLE snd, rcv;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
186 static int cnt;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
187 int size_of_matrix = (MaxEntities+1)*(MaxEntities+1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
188 int snd_len;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
189
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
190 if ( entry == FIRST_ENTRY )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
191 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
192 cnt = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
193 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
194 while ( cnt <= size_of_matrix )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
195 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
196 if ( pf_com_matrix[cnt] != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
197 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
198 snd = cnt/(MaxEntities+1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
199 vsi_e_name (NO_TASK, snd, &dst[0]);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
200 snd_len = strlen(&dst[0]);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
201 dst[snd_len]=' ';
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
202 rcv = cnt%(MaxEntities+1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
203 vsi_e_name (NO_TASK, rcv, &dst[snd_len+1]);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
204 cnt++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
205 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
206 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
207 cnt++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
208 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
209 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
210 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
211 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
212
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
213 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
214 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
215 +--------------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
216 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
217 | STATE : code ROUTINE : vsi_c_get_entity_com_entry|
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
218 +--------------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
219
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
220 PURPOSE : get a entity handle the is used by an entity to send primitives
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
221
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
222 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
223
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
224 int vsi_c_get_entity_com_entry ( int entry, T_HANDLE rcv, T_HANDLE *snd )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
225 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
226 static int cnt;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
227 int size_of_matrix = (MaxEntities+1)*(MaxEntities+1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
228
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
229 if ( entry == FIRST_ENTRY )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
230 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
231 cnt = rcv;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
232 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
233 while ( cnt <= size_of_matrix )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
234 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
235 if ( pf_com_matrix[cnt] != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
236 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
237 *snd = cnt / (MaxEntities + 1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
238 cnt = cnt + MaxEntities + 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
239 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
240 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
241 cnt = cnt + MaxEntities + 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
242 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
243 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
244 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
245 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
246 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
247
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
248 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
249 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
250 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
251 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
252 | STATE : code ROUTINE : vsi_c_open |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
253 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
254
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
255 PURPOSE : get the handle of a queue
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
256
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
257 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
258
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
259 T_HANDLE vsi_c_open (T_HANDLE Caller, char *Name)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
260 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
261 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
262 OS_HANDLE ComHandle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
263
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
264 if ( os_OpenQueue ( Caller, Name, &ComHandle ) != OS_ERROR )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
265 return ComHandle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
266 #else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
267 T_HANDLE e_handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
268
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
269 for ( e_handle = MaxEntities; e_handle > 0; e_handle-- )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
270 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
271 if ( pf_TaskTable[e_handle].Name[0] != 0
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
272 && pf_TaskTable[e_handle].QueueHandle != 0
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
273 && !strncmp (pf_TaskTable[e_handle].Name, Name, RESOURCE_NAMELEN-1) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
274 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
275 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
276 not needed -> temporarily removed
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
277 pf_com_matrix[Caller*(MaxEntities+1)+e_handle] = 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
278 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
279 return e_handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
280 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
281 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
282 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
283 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
284 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
285 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
286
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
287 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
288 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
289 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
290 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
291 | STATE : code ROUTINE : vsi_c_close |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
292 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
293
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
294 PURPOSE : return the handle of a queue
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
295
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
296 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
297
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
298 int vsi_c_close (T_HANDLE Caller, T_HANDLE ComHandle)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
299 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
300
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
301 if ( os_CloseQueue ( Caller, ComHandle ) != OS_ERROR )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
302 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
303
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
304 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
305 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
306 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
307
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
308 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
309 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
310 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
311 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
312 | STATE : code ROUTINE : vsi_c_clear |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
313 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
314
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
315 PURPOSE : read all messages from a queue
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
316
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
317 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
318
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
319 int vsi_c_clear (T_HANDLE Caller, T_HANDLE ComHandle)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
320 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
321 OS_QDATA Msg;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
322
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
323 while ( os_ReceiveFromQueue ( NO_TASK, ComHandle, &Msg, OS_NO_SUSPEND ) == OS_OK )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
324 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
325 ;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
326 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
327
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
328 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
329 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
330 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
331
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
332 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
333 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
334 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
335 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
336 | STATE : code ROUTINE : vsi_c_send |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
337 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
338
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
339 PURPOSE : write a message to a queue
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
340
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
341 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
342
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
343 int vsi_c_send (T_HANDLE Caller, T_HANDLE ComHandle, T_QMSG *Msg FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
344 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
345 OS_QDATA OS_Msg = { 0 };
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
346 LONG Status;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
347 USHORT Prio;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
348 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
349 T_PRIM_HEADER *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
350 #ifdef _TARGET_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
351 T_HANDLE t_handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
352 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
353 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
354
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
355 OS_Msg.data16 = Msg->MsgType;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
356 OS_Msg.e_id = ComHandle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
357 switch ( Msg->MsgType )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
358 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
359 case MSG_PRIMITIVE:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
360 OS_Msg.ptr = Msg->Msg.Primitive.Prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
361 OS_Msg.data32 = P_OPC(Msg->Msg.Primitive.Prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
362 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
363 OS_Msg.len = Msg->Msg.Primitive.PrimLen;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
364 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
365 os_GetTime ( 0, &OS_Msg.time );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
366 Prio = MSG_PRIMITIVE_PRIO;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
367 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
368 case MSG_SIGNAL:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
369 OS_Msg.ptr = Msg->Msg.Signal.SigBuffer;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
370 OS_Msg.data32 = Msg->Msg.Signal.SigOPC;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
371 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
372 OS_Msg.len = Msg->Msg.Signal.SigLen;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
373 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
374 os_GetTime ( 0, &OS_Msg.time );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
375 Prio = MSG_SIGNAL_PRIO;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
376 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
377 default: return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
378 /*lint -e527 suppress Warning -- Unreachable */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
379 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
380 /*lint +e527 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
381 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
382
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
383 #ifdef _NUCLEUS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
384 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
385 /* PARTITION GUARD PATTERN CHECK */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
386 if ( Msg->MsgType == MSG_PRIMITIVE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
387 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
388 prim = (T_PRIM_HEADER*)Msg->Msg.Primitive.Prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
389 if ( (Status = os_PartitionCheck ( (T_VOID_STRUCT*)prim )) == OS_OK )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
390 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
391 if ( check_desclist == TRUE && prim->dph_offset != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
392 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
393 check_descriptor_list ( Caller, prim FILE_LINE );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
394 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
395 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
396 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
397 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
398 switch ( Status )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
399 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
400 case OS_PARTITION_FREE:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
401 vsi_o_assert ( Caller, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
402 "%s (PSEND),entity %s, partition 0x%x, opc 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
403 freed_sent_str, pf_TaskTable[Caller].Name, prim, prim->opc );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
404 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
405 case OS_PARTITION_GUARD_PATTERN_DESTROYED:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
406 vsi_o_assert ( Caller, OS_SYST_ERR_PCB_PATTERN FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
407 "%s (PSEND), entity %s, partition 0x%x, opc 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
408 guard_str, pf_TaskTable[Caller].Name, prim, prim->opc );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
409 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
410 default:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
411 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
412 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
413 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
414 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
415 vsi_ppm_send ( Caller, ComHandle, (T_PRIM_HEADER*)Msg->Msg.Primitive.Prim, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
416 #endif /* MEMORY_SUPERVISION */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
417 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
418 #ifdef _TARGET_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
419 if ( (t_handle = os_MyHandle()) != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
420 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
421 int opc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
422 switch ( os_CheckTaskStack ( t_handle ) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
423 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
424 case OS_ERROR:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
425 if ( Msg->MsgType == MSG_PRIMITIVE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
426 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
427 opc = ((T_PRIM_HEADER*)Msg->Msg.Primitive.Prim)->opc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
428 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
429 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
430 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
431 opc = Msg->Msg.Signal.SigOPC;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
432 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
433 vsi_o_assert ( Caller, OS_SYST_ERR_STACK_OVERFLOW FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
434 "%s Stack overflow, 0x%x", pf_TaskTable[Caller].Name, opc );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
435 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
436 default:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
437 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
438 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
439 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
440 #endif /* _TARGET_ */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
441 #endif /* NU_DEBUG */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
442 #endif /* _NUCLEUS_ */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
443
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
444 Status = rt_Route ( Caller, ComHandle, Prio, OS_SUSPEND, &OS_Msg );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
445
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
446 switch ( Status )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
447 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
448 case OS_WAITED:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
449 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
450 pf_handle_warning ( OS_SYST_WRN_WAIT_QUEUE, "%s %s, entity %s, queue %s, %s(%d)",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
451 syst_wrn, waited_queue_str, pf_TaskTable[Caller].Name, pf_TaskTable[ComHandle].Name FILE_LINE_MACRO_PASSED );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
452 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
453 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
454 /*lint -e527 suppress Warning -- Unreachable */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
455 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
456 /*lint +e527 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
457 case OS_TIMEOUT:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
458 case OS_ERROR:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
459 case OS_INVALID_QUEUE:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
460 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
461 if ( Msg->MsgType == MSG_SIGNAL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
462 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
463 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
464 pf_handle_warning ( OS_SYST_WRN_WAIT_QUEUE, "%s %s from %s to %s, opc 0x%x, %s(%d)",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
465 syst_wrn, disc_str, pf_TaskTable[Caller].Name, pf_TaskTable[ComHandle].Name, Msg->Msg.Signal.SigOPC FILE_LINE_MACRO_PASSED );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
466 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
467 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
468 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
469 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
470 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
471 char const *p_queue_name;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
472 if ( Status == OS_INVALID_QUEUE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
473 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
474 p_queue_name = unknown_str;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
475 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
476 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
477 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
478 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
479 os_GetQueueName ( Caller, ComHandle, QueueName );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
480 p_queue_name = QueueName;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
481 #else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
482 p_queue_name = pf_TaskTable[ComHandle].Name;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
483 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
484 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
485 vsi_o_assert ( Caller, OS_SYST_ERR_QUEUE_FULL FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
486 "%s write attempt to %s queue failed",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
487 pf_TaskTable[Caller].Name, p_queue_name );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
488 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
489 vsi_ppm_free ( Caller, (T_PRIM_HEADER*)(OS_Msg.ptr-PPM_OFFSET), file, line);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
490 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
491 os_DeallocatePartition (Caller, OS_Msg.ptr-PPM_OFFSET );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
492 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
493 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
494 /*lint -e527 suppress Warning -- Unreachable */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
495 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
496 /*lint +e527 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
497 case OS_OK:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
498 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
499 /*lint -e527 suppress Warning -- Unreachable */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
500 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
501 /*lint +e527 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
502 default:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
503 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
504 /*lint -e527 suppress Warning -- Unreachable */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
505 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
506 /*lint +e527 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
507 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
508
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
509 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
510 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
511
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
512 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
513 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
514 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
515 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
516 | STATE : code ROUTINE : vsi_c_psend |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
517 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
518
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
519 PURPOSE : wrapper for vsi_c_send to avoid code wasting macro
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
520
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
521 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
522 int vsi_c_psend_caller ( T_HANDLE Caller, T_HANDLE ComHandle, T_VOID_STRUCT *ptr FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
523 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
524 T_QMSG QMsg;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
525 T_VOID_STRUCT *snd_ptr = (T_VOID_STRUCT*)D2P(ptr);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
526
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
527 QMsg.Msg.Primitive.Prim = snd_ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
528 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
529 if ( ((T_PRIM_HEADER*)snd_ptr)->sh_offset != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
530 QMsg.Msg.Primitive.PrimLen = ALIGN(PSIZE(ptr)) + sizeof(T_S_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
531 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
532 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
533 QMsg.Msg.Primitive.PrimLen = PSIZE(ptr);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
534 QMsg.MsgType = MSG_PRIMITIVE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
535 if ( Caller != TST_Handle && !(P_OPC(QMsg.Msg.Primitive.Prim) & SYS_MASK ) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
536 vsi_o_ptrace (Caller, P_OPC(QMsg.Msg.Primitive.Prim), 1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
537
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
538 #if !defined _TARGET_ && !defined _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
539 if ( (pcheck_active[Caller] == 1) && (pcheck_func.pcheck != NULL) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
540 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
541 ULONG ret;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
542 if ( (ret = pcheck_func.pcheck ( D_OPC(ptr), ptr )) != pcheck_func.ret_ok )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
543 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
544 pf_handle_warning ( OS_SYST_WRN, "%s %s %d in %s, opc 0x%x, %s(%d)",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
545 syst_wrn, pcheck_str, ret, pf_TaskTable[Caller].Name, D_OPC(ptr) FILE_LINE_MACRO_PASSED );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
546 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
547 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
548 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
549 return ( vsi_c_send ( Caller, ComHandle, &QMsg FILE_LINE) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
550 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
551 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
552
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
553 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
554 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
555 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
556 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
557 | STATE : code ROUTINE : vsi_c_psend |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
558 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
559
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
560 PURPOSE : wrapper for vsi_c_send to avoid code wasting macro
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
561
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
562 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
563 int vsi_c_psend ( T_HANDLE ComHandle, T_VOID_STRUCT *ptr FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
564 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
565 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
566
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
567 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
568
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
569 return ( vsi_c_psend_caller ( Caller, ComHandle, ptr FILE_LINE) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
570 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
571 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
572
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
573 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
574 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
575 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
576 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
577 | STATE : code ROUTINE : vsi_c_ssend |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
578 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
579
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
580 PURPOSE : wrapper for vsi_c_send to avoid code wasting macro
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
581
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
582 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
583 int vsi_c_ssend ( T_HANDLE ComHandle, ULONG opc, T_VOID_STRUCT *ptr,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
584 ULONG MsgLen FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
585 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
586 T_QMSG QMsg;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
587 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
588
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
589 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
590
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
591 QMsg.Msg.Signal.SigBuffer = (T_VOID_STRUCT*)ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
592 QMsg.Msg.Signal.SigOPC = opc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
593 QMsg.Msg.Signal.SigLen = MsgLen;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
594 QMsg.MsgType = MSG_SIGNAL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
595
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
596 return ( vsi_c_send ( Caller, ComHandle, &QMsg FILE_LINE ) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
597
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
598 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
599 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
600
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
601 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
602 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
603 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
604 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
605 | STATE : code ROUTINE : vsi_c_new |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
606 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
607
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
608 PURPOSE : allocate a partition to send a primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
609
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
610 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
611
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
612 T_VOID_STRUCT * vsi_c_new (T_HANDLE Caller, ULONG Size, ULONG opc FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
613 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
614 T_VOID_STRUCT *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
615 ULONG flags;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
616
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
617 /* VSI_MEM_NON_BLOCKING not set, blocking allocation for backwards compatibility */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
618 flags = PrimGroupHandle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
619 prim = (T_VOID_STRUCT*)D2P(vsi_c_pnew_generic (Caller, Size, opc, flags FILE_LINE));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
620 return prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
621
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
622 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
623 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
624
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
625 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
626 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
627 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
628 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
629 | STATE : code ROUTINE : vsi_c_new |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
630 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
631
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
632 PURPOSE : allocate a partition to send a primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
633
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
634 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
635
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
636 T_VOID_STRUCT * vsi_c_pnew_generic (T_HANDLE Caller, ULONG Size, ULONG opc, ULONG flags FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
637 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
638 T_VOID_STRUCT *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
639
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
640 if ( Size < sizeof(T_PRIM_HEADER) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
641 Size = sizeof(T_PRIM_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
642
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
643 if ( (prim = vsi_m_new ( Size, flags FILE_LINE )) != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
644 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
645 P_OPC(prim) = opc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
646 P_LEN(prim) = Size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
647 P_SDU(prim) = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
648 P_CNT(prim) = 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
649 P_SHO(prim) = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
650 P_DPHO(prim) = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
651 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
652 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
653 vsi_ppm_new ( Caller, Size, (T_PRIM_HEADER*)prim, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
654 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
655
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
656 #ifndef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
657 if (opc & MEMHANDLE_OPC)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
658 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
659 P_MEMHANDLE_SDU(prim)=0x00000000;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
660 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
661 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
662
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
663 return (T_VOID_STRUCT*)P2D(prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
664 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
665 return NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
666
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
667 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
668 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
669 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
670 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
671 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
672 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
673 | STATE : code ROUTINE : vsi_c_pnew |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
674 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
675
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
676 PURPOSE : allocate a partition to send a primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
677
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
678 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
679
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
680 T_VOID_STRUCT * vsi_c_pnew (ULONG Size, ULONG opc FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
681 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
682 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
683
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
684 Caller = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
685
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
686 Size += sizeof(T_PRIM_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
687
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
688 return ( (T_VOID_STRUCT*)vsi_c_pnew_generic ( Caller, Size, opc, PrimGroupHandle FILE_LINE ));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
689 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
690 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
691
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
692 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
693 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
694 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
695 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
696 | STATE : code ROUTINE : vsi_c_pnew |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
697 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
698
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
699 PURPOSE : allocate a partition to send a primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
700
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
701 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
702
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
703 T_VOID_STRUCT * vsi_c_pnew_nb (ULONG Size, ULONG opc FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
704 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
705 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
706
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
707 Caller = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
708
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
709 Size += sizeof(T_PRIM_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
710
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
711 return ( (T_VOID_STRUCT*)vsi_c_pnew_generic ( Caller, Size, opc, VSI_MEM_NON_BLOCKING|PrimGroupHandle FILE_LINE ));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
712 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
713 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
714
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
715 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
716 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
717 +---------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
718 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
719 | STATE : code ROUTINE : vsi_c_new_sdu_generic|
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
720 +---------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
721
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
722 PURPOSE : allow pool selection and flags for blocking bahavior
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
723
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
724 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
725 T_VOID_STRUCT * vsi_c_new_sdu_generic (ULONG Size, ULONG opc, USHORT sdu_len, USHORT sdu_offset, USHORT encode_offset, ULONG flags FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
726 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
727 T_PRIM_HEADER *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
728 ULONG alloc_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
729 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
730
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
731 Caller = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
732 alloc_size = Size + sizeof(T_PRIM_HEADER) + BYTELEN((SHORT)sdu_len + (SHORT)encode_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
733 if ( (prim = (T_PRIM_HEADER*)vsi_c_pnew_generic (Caller, alloc_size, opc, flags FILE_LINE)) != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
734 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
735 D_SDU(prim) = (T_sdu*)(((char*)prim) + sdu_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
736 D_SDU_LEN(prim) = sdu_len;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
737 D_SDU_OFF(prim) = encode_offset;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
738 return ( (T_VOID_STRUCT*)prim );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
739 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
740 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
741 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
742 return NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
743 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
744 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
745 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
746
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
747 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
748 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
749 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
750 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
751 | STATE : code ROUTINE : vsi_c_new_sdu |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
752 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
753
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
754 PURPOSE : wrapper for vsi_c_new to avoid code wasting macro
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
755
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
756 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
757 T_VOID_STRUCT * vsi_c_new_sdu (ULONG Size, ULONG opc, USHORT sdu_len, USHORT sdu_offset, USHORT encode_offset FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
758 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
759 ULONG flags;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
760
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
761 flags = PrimGroupHandle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
762
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
763 return vsi_c_new_sdu_generic (Size, opc, sdu_len, sdu_offset, encode_offset, flags FILE_LINE);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
764 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
765 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
766
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
767 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
768 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
769 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
770 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
771 | STATE : code ROUTINE : vsi_c_ppass |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
772 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
773
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
774 PURPOSE : pass a partition from one primitive to another
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
775
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
776 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
777 T_VOID_STRUCT * vsi_c_ppass (T_VOID_STRUCT *prim, ULONG opc FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
778 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
779 T_VOID_STRUCT *ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
780 ULONG len;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
781 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
782
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
783 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
784 if ( D_CNT(prim) > 1 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
785 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
786 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
787 * This does not work for dynamic primitive containing pointers, PDUP needed !!!!
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
788 * The sdu pointer is currently not set correctly because it is never used !!!
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
789 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
790 len = D_LEN(prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
791 ptr = vsi_c_pnew ( len, opc FILE_LINE );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
792 memcpy ( ptr, prim, len - sizeof(T_PRIM_HEADER) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
793 #ifdef PRIM_AUTO_FREE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
794 if ( !(pf_TaskTable[Caller].Flags & PARTITION_AUTO_FREE) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
795 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
796 vsi_c_pfree ( &prim FILE_LINE );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
797 return ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
798 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
799 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
800 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
801 D_OPC(prim) = opc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
802 #ifdef PRIM_AUTO_FREE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
803 if ( pf_TaskTable[Caller].Flags & PARTITION_AUTO_FREE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
804 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
805 D_CNT(prim)++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
806 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
807 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
808 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
809 vsi_ppm_reuse ( Caller, D2P(prim), file, line);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
810 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
811 return prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
812 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
813
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
814 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
815 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
816
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
817 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
818 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
819 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
820 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
821 | STATE : code ROUTINE : vsi_c_pstore |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
822 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
823
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
824 PURPOSE : store a partition (increment the reference counter)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
825 consider PARTITION_AUTO_FREE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
826
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
827 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
828 void vsi_c_pstore ( T_VOID_STRUCT *prim FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
829 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
830 #ifdef PRIM_AUTO_FREE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
831 T_PRIM_HEADER *ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
832 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
833 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
834
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
835 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
836 if ( pf_TaskTable[Caller].Flags & PARTITION_AUTO_FREE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
837 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
838 ptr = D2P(prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
839 /* take control -> enable entity to free the prim */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
840 processed_prim[Caller] = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
841 /* increment reference counter */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
842 D_CNT(prim)++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
843 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
844 vsi_ppm_store ( Caller, ptr, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
845 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
846 if ( P_DPHO(ptr) != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
847 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
848 dp_hdr = (T_DP_HEADER*)((ULONG*)ptr + ptr->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
849 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
850 while ( (ptr = (T_PRIM_HEADER*)dp_hdr) != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
851 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
852 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
853 vsi_ppm_store ( Caller, ptr, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
854 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
855 P_CNT(ptr)++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
856 if ( dp_hdr->magic_nr != GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
857 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
858 vsi_o_assert ( Caller, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
859 "Magic number in dp_header destroyed (PSTORE) %s , opc: 0x%lx, partition 0x%lx",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
860 pf_TaskTable[Caller].Name, ptr->opc, ptr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
861 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
862 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
863 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
864 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
865 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
866 #endif /* PRIM_AUTO_FREE */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
867 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
868 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
869
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
870 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
871 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
872 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
873 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
874 | STATE : code ROUTINE : vsi_c_pattach |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
875 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
876
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
877 PURPOSE : call internal function to store a partition (increment the reference counter)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
878
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
879 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
880 int vsi_c_pattach ( T_VOID_STRUCT *prim FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
881 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
882 T_HANDLE Caller = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
883 LONG sts;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
884 int ret;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
885
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
886 sts = os_ObtainSemaphore (Caller, vsi_m_sem_handle, OS_SUSPEND);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
887 if ( sts == OS_ERROR || sts == OS_TIMEOUT )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
888 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
889 /* Semaphore invalid or overrun */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
890 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
891 vsi_o_assert ( NO_TASK, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
892 "Ref Cnt Semaphore overrun, entity %s", pf_TaskTable[Caller].Name );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
893 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
894
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
895 ret=int_vsi_c_pattach(prim FILE_LINE_MACRO);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
896
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
897 os_ReleaseSemaphore (Caller, vsi_m_sem_handle);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
898
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
899 return ret;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
900 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
901
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
902 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
903 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
904 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
905 | STATE : code ROUTINE : int_vsi_c_pattach |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
906 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
907
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
908 PURPOSE : actually store a partition (increment the reference counter)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
909
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
910 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
911 int int_vsi_c_pattach ( T_VOID_STRUCT *prim FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
912 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
913 T_PRIM_HEADER *ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
914 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
915 T_HANDLE Caller = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
916 int pos;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
917
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
918 ptr = D2P(prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
919
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
920 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
921 if ( os_is_valid_partition ((T_VOID_STRUCT*)ptr) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
922 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
923 /* attach to non-partition memory */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
924 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
925 vsi_o_assert ( NO_TASK, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
926 "PATTACH to non-partition memory, entity %s, ptr 0x%x", pf_TaskTable[Caller].Name, ptr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
927 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
928 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
929
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
930 if ( ptr->use_cnt <= 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
931 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
932 /* attach to non allocated memory */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
933 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
934 vsi_o_assert ( NO_TASK, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
935 "PATTACH to free memory, entity %s, ptr 0x%x", pf_TaskTable[Caller].Name, ptr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
936 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
937
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
938 dp_hdr=NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
939
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
940 /* check if we have a primitive pointer */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
941 if ( ((T_DP_HEADER*)ptr)->magic_nr != GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
942 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
943 /* increment reference counter */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
944 P_CNT(ptr)++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
945 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
946 vsi_ppm_store ( Caller, ptr, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
947 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
948
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
949 /* look for dynamic partition header */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
950 if ( P_DPHO(ptr) != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
951 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
952 dp_hdr = (T_DP_HEADER*)((ULONG*)ptr + ptr->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
953 if (dp_hdr->drp_bound_list)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
954 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
955 /* call attach for bound root pointers */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
956 pos=0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
957 while(pos<MAX_DRP_BOUND && dp_hdr->drp_bound_list[pos])
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
958 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
959 int_vsi_c_pattach(dp_hdr->drp_bound_list[pos] FILE_LINE_MACRO);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
960 pos++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
961 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
962 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
963
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
964 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
965 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
966 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
967 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
968 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
969 dp_hdr=(T_DP_HEADER*)ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
970 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
971
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
972 if ( dp_hdr )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
973 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
974 if ( dp_hdr->magic_nr != GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
975 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
976 /* primitive with T_desc_list element, use MATTACH */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
977 os_ReleaseSemaphore (Caller, vsi_m_sem_handle);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
978 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
979 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
980 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
981 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
982 while ( (ptr = (T_PRIM_HEADER*)dp_hdr) != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
983 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
984 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
985 vsi_ppm_store ( Caller, ptr, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
986 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
987 P_CNT(ptr)++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
988 if ( dp_hdr->magic_nr != GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
989 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
990 vsi_o_assert ( Caller, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
991 "Magic number in dp_header destroyed (PATTACH), %s, opc: 0x%lx, partition 0x%lx",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
992 pf_TaskTable[Caller].Name, ptr->opc, ptr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
993 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
994
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
995 if (dp_hdr->drp_bound_list)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
996 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
997 /* call attach for bound root pointers */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
998 pos=0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
999 while(pos<MAX_DRP_BOUND && dp_hdr->drp_bound_list[pos])
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1000 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1001 int_vsi_c_pattach(dp_hdr->drp_bound_list[pos] FILE_LINE_MACRO);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1002 pos++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1003 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1004 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1005 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1006 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1007 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1008 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1009 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1010 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1011 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1012
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1013 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1014 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1015 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1016 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1017 | STATE : code ROUTINE : vsi_c_reuse |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1018 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1019
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1020 PURPOSE : function to avoid code wasting macro
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1021
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1022 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1023 T_VOID_STRUCT *vsi_c_reuse ( T_PRIM_HEADER *ptr, ULONG Size, ULONG opc,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1024 USHORT sdu_len, USHORT sdu_offset, USHORT encode_offset FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1025 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1026 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1027
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1028 D_OPC(ptr) = opc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1029 D_LEN(ptr) = Size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1030 if ( sdu_offset != NO_SDU )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1031 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1032 D_SDU(ptr) = (T_sdu*)((char*)(ptr) + sdu_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1033 D_SDU_LEN(ptr) = sdu_len;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1034 D_SDU_OFF(ptr) = encode_offset;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1035 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1036 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1037 D_SDU(ptr) = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1038
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1039 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1040 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1041 vsi_ppm_reuse ( Caller, D2P(ptr), file, line);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1042 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1043 #ifdef PRIM_AUTO_FREE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1044 if ( pf_TaskTable[Caller].Flags & PARTITION_AUTO_FREE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1045 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1046 D_CNT(ptr)++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1047 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1048 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1049 return ( (T_VOID_STRUCT*)ptr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1050 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1051 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1052
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1053 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1054 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1055 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1056 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1057 | STATE : code ROUTINE : vsi_c_free |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1058 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1059
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1060 PURPOSE : deallocate a partition that was used to send a primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1061
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1062 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1063
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1064 int vsi_c_free (T_HANDLE Caller, T_VOID_STRUCT **Msg FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1065 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1066 static T_VOID_STRUCT *protected_prim_to_free = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1067 #if defined (NU_DEBUG) || defined (OSL_DEBUG)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1068 LONG count;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1069 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1070
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1071 //LONG sts;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1072
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1073 #if 0
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1074 sts = os_ObtainSemaphore (Caller, vsi_m_sem_handle, OS_SUSPEND);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1075 if ( sts == OS_ERROR || sts == OS_TIMEOUT )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1076 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1077 /* Semaphore invalid or overrun */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1078 if ( *Msg == protected_prim_to_free )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1079 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1080 /* fatal error only if semaphore overrun on same primitive */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1081 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1082 vsi_o_assert ( NO_TASK, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1083 "Ref Cnt Semaphore overrun, entity %s", pf_TaskTable[Caller].Name );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1084 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1085 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1086 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1087 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1088 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1089 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1090 protected_prim_to_free = *Msg;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1091 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1092 #if defined (NU_DEBUG) || defined (OSL_DEBUG)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1093 count = (LONG)((T_PRIM_HEADER*)*Msg)->use_cnt;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1094 if ( count <= 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1095 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1096 pf_handle_warning ( OS_SYST_WRN_MULTIPLE_FREE, "%s %s in %s, 0x%x, %s(%d)",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1097 syst_wrn, freed_str, pf_TaskTable[Caller].Name, P_OPC(*Msg) FILE_LINE_MACRO_PASSED );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1098 protected_prim_to_free = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1099 // os_ReleaseSemaphore (Caller, vsi_m_sem_handle);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1100 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1101 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1102 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1103 if ( --((T_PRIM_HEADER*)*Msg)->use_cnt == 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1104 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1105 #ifdef PRIM_AUTO_FREE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1106 if ( pf_TaskTable[Caller].Flags & PARTITION_AUTO_FREE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1107 freed_prim[Caller] = *Msg;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1108 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1109 #ifdef _NUCLEUS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1110 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1111
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1112 if ( os_PartitionCheck( (ULONG*)*Msg ) == OS_PARTITION_GUARD_PATTERN_DESTROYED )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1113 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1114 // os_ReleaseSemaphore (Caller, vsi_m_sem_handle);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1115 vsi_o_assert ( Caller, OS_SYST_ERR_PCB_PATTERN FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1116 "%s (PFREE), entity %s,Partition 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1117 guard_str, pf_TaskTable[Caller].Name, *Msg );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1118 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1119 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1120 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1121 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1122 protected_prim_to_free = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1123 // os_ReleaseSemaphore (Caller, vsi_m_sem_handle);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1124 return ( vsi_m_free ( Msg FILE_LINE ) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1125 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1126
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1127 protected_prim_to_free = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1128 // os_ReleaseSemaphore (Caller, vsi_m_sem_handle);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1129 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1130 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1131 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1132
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1133 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1134 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1135 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1136 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1137 | STATE : code ROUTINE : vsi_c_pfree |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1138 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1139
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1140 PURPOSE : deallocate a partition that was used to send a primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1141
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1142 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1143
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1144 int vsi_c_pfree (T_VOID_STRUCT **Msg FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1145 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1146 T_VOID_STRUCT *free_ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1147 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1148
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1149 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1150 * PFREE is disabled if the primitive to be freed is the currently
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1151 * processed one and the auto free is enabled for the calling entity
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1152 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1153
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1154 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1155 free_ptr = (T_VOID_STRUCT*)D2P(*Msg);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1156 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1157 if ( os_is_valid_partition ((T_VOID_STRUCT*)free_ptr) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1158 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1159 /* free to non-partition memory */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1160 vsi_o_assert ( NO_TASK, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1161 "PFREE to non-partition memory, entity %s, prim 0x%x", pf_TaskTable[Caller].Name, *Msg );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1162 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1163 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1164 #ifdef PRIM_AUTO_FREE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1165 if ( free_ptr == processed_prim[Caller] && pf_TaskTable[Caller].Flags & PARTITION_AUTO_FREE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1166 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1167 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1168 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1169 #endif /* PRIM_AUTO_FREE */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1170 return ( vsi_c_free ( Caller, &free_ptr FILE_LINE ) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1171 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1172 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1173
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1174 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1175 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1176 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1177 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1178 | STATE : code ROUTINE : vsi_c_await |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1179 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1180
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1181 PURPOSE : receive a primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1182
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1183 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1184
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1185 int vsi_c_await (T_HANDLE Caller, T_HANDLE ComHandle, T_QMSG *Msg, ULONG Timeout)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1186 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1187 OS_QDATA OS_Msg;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1188 LONG ret;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1189 OS_HANDLE q_handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1190
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1191
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1192 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1193 q_handle = ComHandle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1194 #else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1195 q_handle = pf_TaskTable[ComHandle].QueueHandle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1196 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1197 e_running[os_MyHandle()] = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1198
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1199 if ( (ret = os_ReceiveFromQueue ( Caller, q_handle, &OS_Msg, Timeout)) == OS_OK )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1200 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1201 Msg->MsgType = OS_Msg.data16;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1202 switch ( Msg->MsgType )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1203 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1204 case MSG_PRIMITIVE:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1205 Msg->Msg.Primitive.Prim = OS_Msg.ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1206 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1207 Msg->Msg.Primitive.PrimLen = OS_Msg.len;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1208 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1209 vsi_o_ptrace (Caller, ((T_PRIM_HEADER*)Msg->Msg.Primitive.Prim)->opc, 0);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1210 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1211 case MSG_SIGNAL:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1212 Msg->Msg.Signal.SigBuffer = OS_Msg.ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1213 Msg->Msg.Signal.SigOPC = OS_Msg.data32;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1214 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1215 Msg->Msg.Signal.SigLen = OS_Msg.len;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1216 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1217 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1218 case MSG_TIMEOUT:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1219 if ( *(pf_TaskTable[Caller].FirstTimerEntry + OS_Msg.data32) & TIMEOUT_OCCURRED )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1220 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1221 if ( !(*(pf_TaskTable[Caller].FirstTimerEntry + OS_Msg.data32) & PERIODIC_TIMER) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1222 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1223 os_DestroyTimer ( Caller, (OS_HANDLE)(*(pf_TaskTable[Caller].FirstTimerEntry + OS_Msg.data32) & TIMER_HANDLE_MASK) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1224 *(pf_TaskTable[Caller].FirstTimerEntry + OS_Msg.data32) = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1225 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1226 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1227 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1228 *(pf_TaskTable[Caller].FirstTimerEntry + OS_Msg.data32) &= ~TIMEOUT_OCCURRED;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1229 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1230 Msg->Msg.Timer.Index = OS_Msg.data32;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1231 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1232 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1233 default: return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1234 /*lint -e527 suppress Warning -- Unreachable */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1235 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1236 /*lint +e527 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1237 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1238 e_running[os_MyHandle()] = Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1239 prf_log_entity_activate ((void*)Caller);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1240 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1241 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1242 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1243 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1244 if ( ret == OS_TIMEOUT )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1245 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1246 e_running[os_MyHandle()] = Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1247 return VSI_TIMEOUT;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1248 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1249 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1250 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1251 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1252 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1253
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1254 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1255 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1256 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1257 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1258 | STATE : code ROUTINE : vsi_c_primitive |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1259 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1260
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1261 PURPOSE : send a non GSM primitive to the frame
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1262
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1263 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1264
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1265 int vsi_c_primitive (T_HANDLE Caller, void *Msg)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1266 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1267 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1268 * the following line of code causes a warning on tms470 compiler, that cannot be avoided
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1269 * without changing all entities PEI modules. Warning will not cause a problem
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1270 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1271 pf_ProcessSystemPrim ( Caller, Msg );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1272 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1273
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1274 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1275 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1276
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1277 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1278 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1279 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1280 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1281 | STATE : code ROUTINE : vsi_c_awake |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1282 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1283
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1284 PURPOSE : send NULL primitive to itself
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1285
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1286 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1287 GLOBAL int vsi_c_awake ( T_HANDLE caller )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1288 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1289 OS_QDATA QMsg = { 0 };
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1290
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1291 QMsg.data16 = MSG_PRIMITIVE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1292 QMsg.ptr = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1293 os_SendToQueue ( caller, caller, OS_URGENT, OS_NO_SUSPEND, &QMsg );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1294 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1295 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1296 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1297
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1298 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1299 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1300 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1301 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1302 | STATE : code ROUTINE : vsi_c_status |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1303 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1304
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1305 PURPOSE : allocate root of dynamic sized primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1306
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1307 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1308 int vsi_c_status (T_HANDLE handle, unsigned int *used, unsigned int *free)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1309 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1310 #ifdef _NUCLEUS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1311 int status;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1312
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1313 if ( (status = os_GetQueueState (0, pf_TaskTable[handle].QueueHandle, (ULONG*)used, (ULONG*)free)) == OS_OK )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1314 return OS_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1315 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1316 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1317 return OS_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1318
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1319 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1320 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1321
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1322 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1323 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1324 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1325 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1326 | STATE : code ROUTINE : vsi_drpo_new |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1327 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1328
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1329 PURPOSE : allocate root of dynamic sized primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1330
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1331 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1332 GLOBAL T_VOID_STRUCT *vsi_drpo_new ( ULONG size, ULONG opc, ULONG guess FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1333 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1334 T_PRIM_HEADER *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1335 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1336 T_S_HEADER *s_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1337 ULONG alloc_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1338 ULONG partition_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1339 ULONG header_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1340 T_HANDLE caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1341
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1342 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1343
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1344 header_size = sizeof(T_PRIM_HEADER) + sizeof(T_DP_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1345
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1346 if ( ALIGN(header_size + size) > MaxPrimPartSize )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1347 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1348 os_GetTaskName ( caller, caller, TaskName );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1349 vsi_o_assert ( NO_TASK, OS_SYST_ERR_BIG_PARTITION FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1350 "No Partition available, entity %s, size %d", pf_TaskTable[caller].Name, size );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1351 return NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1352 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1353
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1354 if ( guess == DP_NO_FRAME_GUESS )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1355 alloc_size = ALIGN(header_size + size);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1356 else if ( guess == DP_FRAME_GUESS )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1357 alloc_size = ALIGN(header_size + size * 3);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1358 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1359 alloc_size = ALIGN(header_size + guess + size);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1360
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1361 if ( caller != 0 && caller == TST_Handle )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1362 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1363 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1364 if called by PCON in the test interface while decoding we need to reserve
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1365 space for the S_HEADER
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1366 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1367 alloc_size += sizeof(T_S_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1368 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1369
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1370 if ( alloc_size > MaxPrimPartSize )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1371 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1372 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1373 pf_handle_warning ( OS_SYST_WRN_REQ_TRUNCATED, "%s %s (%d->%d), entity %s, opc 0x%x, %s(%d)",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1374 syst_wrn, trunc_str, alloc_size, MaxPrimPartSize, pf_TaskTable[caller].Name, opc FILE_LINE_MACRO_PASSED );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1375 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1376 alloc_size = MaxPrimPartSize;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1377 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1378 if ( ( prim = (T_PRIM_HEADER*)vsi_m_new_size ( alloc_size, PrimGroupHandle,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1379 &partition_size FILE_LINE ) ) != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1380 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1381 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1382 vsi_ppm_new ( caller, alloc_size, (T_PRIM_HEADER*)prim, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1383 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1384 prim->len = partition_size; /* complete partition because header is at the end */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1385 prim->opc = opc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1386 prim->sdu = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1387 prim->use_cnt = 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1388 prim->sh_offset = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1389 prim->dph_offset = D_HDR_OFFSET(partition_size);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1390 dp_hdr = (T_DP_HEADER*)((ULONG*)prim + prim->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1391 dp_hdr->magic_nr = GUARD_PATTERN;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1392 dp_hdr->drp_bound_list = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1393 dp_hdr->next = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1394 dp_hdr->offset = sizeof(T_PRIM_HEADER) + ALIGN(size);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1395 dp_hdr->size = partition_size - sizeof(T_DP_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1396 if ( dp_hdr->offset > dp_hdr->size )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1397 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1398 dp_hdr->offset = dp_hdr->size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1399 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1400 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1401 * The following code does not work since the 'caller' parameter has been removed from the function
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1402 * prototype. The code was needed for the case where the function was called by PCON when decoding a
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1403 * received primitive in the test interface. The caller in this case is 0 because it is either the
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1404 * RCV_HISR on the target or the EXTR task in the simulation which is not running in the context of
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1405 * the frame. Currently the sh_offset is set in the TIF driver tif.c although the guard pattern is not
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1406 * set there. This is working fine so there is no reason to modify the code here. This comment
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1407 * is just the result of some brainstorming and can be used for future modifications
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1408 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1409 if ( caller != 0 && caller == TST_Handle ) /* called by PCON */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1410 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1411 prim->sh_offset = prim->dph_offset - sizeof(T_S_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1412 dp_hdr->size = dp_hdr->size - sizeof(T_S_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1413 s_hdr = (T_S_HEADER*)((ULONG*)prim + prim->sh_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1414 s_hdr->magic_nr = GUARD_PATTERN;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1415 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1416 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1417 prim->sh_offset = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1418 return ((T_VOID_STRUCT*)P2D(prim));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1419 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1420 return NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1421 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1422 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1423
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1424 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1425 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1426 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1427 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1428 | STATE : code ROUTINE : vsi_drpo_new_sdu |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1429 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1430
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1431 PURPOSE : allocate dynamic sized partition root
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1432
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1433 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1434
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1435 T_VOID_STRUCT * vsi_drpo_new_sdu (ULONG Size, ULONG opc, USHORT sdu_len,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1436 USHORT sdu_offset, USHORT encode_offset, ULONG guess FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1437 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1438 T_VOID_STRUCT *ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1439 ULONG alloc_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1440 T_HANDLE Caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1441
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1442 Caller = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1443 alloc_size = Size + BYTELEN((SHORT)sdu_len + (SHORT)encode_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1444 ptr = vsi_drpo_new ( alloc_size, opc, guess FILE_LINE );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1445 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1446 * the following line of code causes a warning on tms470 compiler,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1447 * that cannot be avoided. Warning will not cause a problem because due to the
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1448 * arm7 alignment it is guaranteed that the sdu will start at an address divisable
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1449 * by 4.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1450 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1451 D_SDU(ptr) = (T_sdu*)((char*)ptr + sdu_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1452 D_SDU_LEN(ptr) = sdu_len;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1453 D_SDU_OFF(ptr) = encode_offset;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1454
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1455 return ( (T_VOID_STRUCT*)ptr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1456 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1457 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1458
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1459 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1460 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1461 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1462 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1463 | STATE : code ROUTINE : vsi_drp_bind |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1464 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1465
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1466 PURPOSE : bind child root pointer to a given parent root pointer
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1467
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1468 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1469 GLOBAL int vsi_drp_bind (T_VOID_STRUCT *child, T_VOID_STRUCT *parent FILE_LINE_TYPE)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1470 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1471 T_PRIM_HEADER *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1472 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1473 T_VOID_STRUCT **new_drp_bound_list;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1474 ULONG alloc_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1475 T_HANDLE caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1476 int pos;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1477
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1478 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1479
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1480 prim = D2P(parent);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1481 if ( ((T_DP_HEADER*)prim)->magic_nr == GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1482 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1483 dp_hdr = (T_DP_HEADER*)prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1484 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1485 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1486 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1487 dp_hdr = (T_DP_HEADER*)((ULONG*)prim + prim->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1488 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1489
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1490 if (dp_hdr->drp_bound_list == NULL)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1491 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1492 /* no partitions bound so far */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1493 alloc_size=MAX_DRP_BOUND*sizeof(T_DP_HEADER*);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1494 if ( ( new_drp_bound_list = (T_VOID_STRUCT**)M_ALLOC (alloc_size) ) == NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1495 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1496 /* no more memory */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1497 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1498 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1499
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1500 memset(new_drp_bound_list,0x00,alloc_size);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1501 dp_hdr->drp_bound_list=new_drp_bound_list;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1502 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1503
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1504 /* find free bind pointer */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1505 pos=0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1506 while(pos<MAX_DRP_BOUND && dp_hdr->drp_bound_list[pos])
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1507 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1508 pos++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1509 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1510 if (pos == MAX_DRP_BOUND)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1511 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1512 /* no more free bound pointers */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1513 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1514 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1515
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1516 /* actually bind */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1517 P_ATTACH(child);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1518 dp_hdr->drp_bound_list[pos]=child;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1519
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1520 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1521 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1522
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1523 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1524 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1525 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1526 | STATE : code ROUTINE : vsi_dp_new |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1527 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1528
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1529 PURPOSE : allocate dynamic sized partition root
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1530
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1531 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1532 GLOBAL T_VOID_STRUCT *vsi_dp_new ( ULONG size, T_VOID_STRUCT *addr, ULONG guess FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1533 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1534 T_PRIM_HEADER *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1535 T_PRIM_HEADER *last_in_chain;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1536 T_PRIM_HEADER *dyn_ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1537 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1538 T_DP_HEADER *new_prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1539 T_VOID_STRUCT *ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1540 ULONG partition_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1541 ULONG alloc_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1542 //ULONG estimated_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1543 T_HANDLE caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1544 char is_opc_root;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1545
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1546 if ( size + sizeof(T_DP_HEADER) > MaxPrimPartSize )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1547 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1548 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1549 vsi_o_assert ( NO_TASK, OS_SYST_ERR_BIG_PARTITION FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1550 "No Partition available, entity %s, size %d", pf_TaskTable[caller].Name, size );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1551 return NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1552 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1553 prim = D2P(addr);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1554 dyn_ptr = prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1555 if ( ((T_DP_HEADER*)prim)->magic_nr == GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1556 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1557 dp_hdr = (T_DP_HEADER*)prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1558 is_opc_root = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1559 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1560 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1561 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1562 dp_hdr = (T_DP_HEADER*)((ULONG*)prim + prim->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1563 is_opc_root = 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1564 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1565
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1566 if ( guess == DP_NO_FRAME_GUESS )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1567 alloc_size = size + sizeof(T_DP_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1568 else if ( guess == DP_FRAME_GUESS )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1569 alloc_size = size * 3 + sizeof(T_DP_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1570 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1571 alloc_size = size + guess + sizeof(T_DP_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1572
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1573 #if 0
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1574 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1575 * update estimated size
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1576 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1577 estimated_size = dp_hdr->est_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1578
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1579 if ( guess != DP_NO_FRAME_GUESS && guess != DP_FRAME_GUESS )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1580 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1581 estimated_size = size + guess;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1582 alloc_size = estimated_size + sizeof(T_DP_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1583 estimated_size -= size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1584 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1585 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1586 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1587 if ( size > estimated_size )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1588 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1589 if ( guess == DP_FRAME_GUESS )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1590 estimated_size = size * 3;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1591 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1592 estimated_size = size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1593 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1594 estimated_size -= size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1595 if ( size > estimated_size )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1596 estimated_size = size * 2;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1597 alloc_size = estimated_size + sizeof(T_DP_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1598 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1599
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1600 if ( estimated_size > MaxPrimPartSize )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1601 estimated_size = MaxPrimPartSize;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1602
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1603 dp_hdr->est_size = estimated_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1604 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1605 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1606 * check if free space in already allocated blocks (first fit)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1607 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1608 do
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1609 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1610 if ( dp_hdr->magic_nr != GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1611 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1612 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1613 vsi_o_assert ( caller, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1614 "Magic number in dp_header destroyed (DP_ALLOC), %s opc: 0x%lx, partition 0x%lx",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1615 pf_TaskTable[caller].Name, ((T_PRIM_HEADER*)prim)->opc, prim );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1616 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1617 if ( dp_hdr->size - dp_hdr->offset > size )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1618 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1619 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1620 * if root was allocated with drpo_alloc then dp header is at the end,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1621 * the dph offset is not 0 and a primitive header is present.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1622 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1623 if ( is_opc_root && dyn_ptr == prim )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1624 ptr = (T_VOID_STRUCT*)(((ULONG*)prim) + (dp_hdr->offset>>2));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1625 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1626 ptr = (T_VOID_STRUCT*)(((ULONG*)dp_hdr) + (dp_hdr->offset>>2));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1627 dp_hdr->offset += ALIGN(size);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1628 return ( ptr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1629 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1630 if ( is_opc_root && dyn_ptr == prim )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1631 last_in_chain = prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1632 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1633 last_in_chain = (T_PRIM_HEADER*)dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1634 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1635 dyn_ptr = (T_PRIM_HEADER*)dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1636 } while ( dp_hdr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1637
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1638 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1639 * not enough free space -> additional allocation needed
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1640 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1641 if ( alloc_size > MaxPrimPartSize )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1642 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1643 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1644 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1645 pf_handle_warning ( OS_SYST_WRN_REQ_TRUNCATED, "%s %s (%d->%d), entity %s, %s(%d)",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1646 syst_wrn, trunc_str, alloc_size, MaxPrimPartSize, pf_TaskTable[caller].Name FILE_LINE_MACRO_PASSED );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1647 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1648 alloc_size = MaxPrimPartSize;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1649 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1650
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1651 if ( ( new_prim = (T_DP_HEADER*)vsi_m_new_size ( alloc_size, PrimGroupHandle,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1652 &partition_size FILE_LINE ) ) != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1653 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1654 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1655 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1656 vsi_ppm_new ( caller, alloc_size, (T_PRIM_HEADER*)new_prim, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1657 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1658 if ( ((T_DP_HEADER*)last_in_chain)->magic_nr == GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1659 dp_hdr = (T_DP_HEADER*)last_in_chain;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1660 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1661 dp_hdr = (T_DP_HEADER*)((ULONG*)last_in_chain + last_in_chain->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1662 dp_hdr->next = new_prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1663 new_prim->magic_nr = GUARD_PATTERN;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1664 new_prim->drp_bound_list = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1665 new_prim->use_cnt = 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1666 new_prim->next = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1667 new_prim->size = partition_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1668 new_prim->offset = sizeof(T_DP_HEADER) + ALIGN(size);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1669 if ( new_prim->offset > new_prim->size )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1670 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1671 new_prim->offset = new_prim->size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1672 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1673 return (T_VOID_STRUCT*)(new_prim + 1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1674 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1675
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1676 return NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1677 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1678 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1679
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1680 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1681 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1682 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1683 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1684 | STATE : code ROUTINE : vsi_c_drp_new |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1685 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1686
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1687 PURPOSE : allocate dynamic sized partition except root
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1688
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1689 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1690 GLOBAL T_VOID_STRUCT *vsi_drp_new ( ULONG size, ULONG guess FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1691 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1692 T_PRIM_HEADER *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1693 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1694 ULONG alloc_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1695 ULONG header_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1696 ULONG partition_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1697 T_HANDLE caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1698
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1699 header_size = sizeof(T_DP_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1700
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1701 if ( ALIGN(header_size + size) > MaxPrimPartSize )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1702 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1703 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1704 os_GetTaskName ( caller, caller, TaskName );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1705 vsi_o_assert ( NO_TASK, OS_SYST_ERR_BIG_PARTITION FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1706 "No Partition available, entity %s, size %d", pf_TaskTable[caller].Name, size );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1707 return NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1708 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1709
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1710 if ( guess == DP_NO_FRAME_GUESS )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1711 alloc_size = header_size + size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1712 else if ( guess == DP_FRAME_GUESS )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1713 alloc_size = header_size + size * 3;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1714 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1715 alloc_size = header_size + guess + size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1716
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1717 if ( alloc_size > MaxPrimPartSize )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1718 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1719 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1720 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1721 pf_handle_warning ( OS_SYST_WRN_REQ_TRUNCATED, "%s %s (%d->%d), entity %s, %s(%d)",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1722 syst_wrn, trunc_str, alloc_size, MaxPrimPartSize, pf_TaskTable[caller].Name FILE_LINE_MACRO_PASSED );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1723 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1724 alloc_size = MaxPrimPartSize;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1725 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1726
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1727 if ( ( prim = (T_PRIM_HEADER*)vsi_m_new_size ( alloc_size, PrimGroupHandle,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1728 &partition_size FILE_LINE ) ) != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1729 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1730 #ifdef MEMORY_SUPERVISION
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1731 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1732 vsi_ppm_new ( caller, alloc_size, (T_PRIM_HEADER*)prim, file, line );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1733 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1734 dp_hdr = (T_DP_HEADER*)prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1735 dp_hdr->next = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1736 dp_hdr->magic_nr = GUARD_PATTERN;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1737 dp_hdr->drp_bound_list = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1738 dp_hdr->use_cnt = 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1739 dp_hdr->offset = sizeof(T_DP_HEADER) + ALIGN(size);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1740 dp_hdr->size = partition_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1741 if ( dp_hdr->offset > dp_hdr->size )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1742 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1743 dp_hdr->offset = dp_hdr->size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1744 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1745 return (T_VOID_STRUCT*)(dp_hdr+1);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1746 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1747
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1748 return NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1749 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1750 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1751
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1752 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1753 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1754 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1755 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1756 | STATE : code ROUTINE : vsi_free |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1757 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1758
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1759 PURPOSE : deallocate a chain of linked partitions
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1760
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1761 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1762
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1763 int vsi_free ( T_VOID_STRUCT **Msg FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1764 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1765 T_PRIM_HEADER *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1766 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1767 T_VOID_STRUCT** drp_bound_list;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1768 T_HANDLE Caller = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1769 int pos;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1770
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1771 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1772 * PFREE is disabled if the primitive to be freed is the currently
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1773 * processed one and the auto free is enabled for the calling entity
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1774 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1775
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1776 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1777
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1778 prim = D2P(*Msg);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1779
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1780 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1781 if ( os_is_valid_partition ((T_VOID_STRUCT*)prim) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1782 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1783 /* free to non-partition memory */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1784 Caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1785 vsi_o_assert ( NO_TASK, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1786 "FREE to non-partition memory, entity %s, prim 0x%x", pf_TaskTable[Caller].Name, *Msg );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1787 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1788 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1789
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1790 #ifdef PRIM_AUTO_FREE
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1791 if ( prim == (T_PRIM_HEADER*)processed_prim[Caller] && pf_TaskTable[Caller].Flags & PARTITION_AUTO_FREE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1792 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1793 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1794 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1795 #endif /* PRIM_AUTO_FREE */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1796
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1797 /* check if we have dynamic partition or primitive */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1798 if ( ((T_DP_HEADER*)prim)->magic_nr == GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1799 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1800 dp_hdr = (T_DP_HEADER*)prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1801 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1802 else if ( prim->dph_offset != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1803 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1804 dp_hdr = (T_DP_HEADER*)((ULONG*)prim + prim->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1805 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1806 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1807 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1808 return ( vsi_c_free ( Caller, (T_VOID_STRUCT**)&prim FILE_LINE ) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1809 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1810
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1811 if ( dp_hdr->magic_nr != GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1812 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1813 /* primitive with T_desc_list element */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1814 vsi_c_free ( Caller, (T_VOID_STRUCT**)&prim FILE_LINE );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1815 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1816 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1817 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1818 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1819 do
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1820 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1821 drp_bound_list=dp_hdr->drp_bound_list;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1822 if (drp_bound_list)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1823 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1824 /* call free for bound root pointers */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1825 pos=0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1826 while(pos<MAX_DRP_BOUND && drp_bound_list[pos])
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1827 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1828 FREE(drp_bound_list[pos]);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1829 pos++;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1830 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1831 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1832
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1833 /* free linked memory */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1834 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1835 vsi_c_free ( Caller, (T_VOID_STRUCT**)&prim FILE_LINE );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1836
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1837 if (prim == NULL && drp_bound_list)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1838 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1839 /* free drp_bound_list */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1840 M_FREE(drp_bound_list);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1841 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1842 } while ( (prim = (T_PRIM_HEADER*)dp_hdr) != NULL );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1843 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1844 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1845 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1846 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1847
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1848 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1849 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1850 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1851 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1852 | STATE : code ROUTINE : vsi_d_sum |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1853 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1854
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1855 PURPOSE : get number of bytes in dynamic sized primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1856
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1857 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1858 GLOBAL int vsi_dp_sum ( T_VOID_STRUCT *addr, ULONG *bytes )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1859 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1860 T_PRIM_HEADER *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1861 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1862 ULONG size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1863 T_HANDLE caller;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1864
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1865 prim = D2P(addr);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1866 if ( ((T_DP_HEADER*)prim)->magic_nr == GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1867 dp_hdr = (T_DP_HEADER*)prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1868 else if ( prim->dph_offset != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1869 dp_hdr = (T_DP_HEADER*)((ULONG*)prim + prim->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1870 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1871 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1872 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1873 vsi_o_ttrace ( NO_TASK, TC_SYSTEM, "SYSTEM WARNING: No root of linked memory in %s",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1874 pf_TaskTable[caller].Name );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1875 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1876 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1877
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1878 size = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1879 do
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1880 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1881 if ( dp_hdr->magic_nr != GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1882 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1883 caller = e_running[os_MyHandle()];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1884 vsi_o_assert ( caller, OS_SYST_ERR, __FILE__, __LINE__,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1885 "Magic number in dp_header destroyed, opc: 0x%lx, partition 0x%lx",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1886 prim->opc, prim );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1887 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1888 size += (dp_hdr->offset-sizeof(T_DP_HEADER));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1889 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1890 } while ( (prim = (T_PRIM_HEADER*)dp_hdr) != NULL );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1891
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1892 *bytes = size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1893 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1894 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1895 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1896
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1897 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1898 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1899 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1900 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1901 | STATE : code ROUTINE : vsi_dp_max_size |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1902 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1903
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1904 PURPOSE : get maximum number of bytes available for user data
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1905 in dynamic primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1906
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1907 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1908 GLOBAL int vsi_dp_max_size ( void )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1909 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1910 return ( (int)(MaxPrimPartSize - sizeof(T_PRIM_HEADER) - sizeof(T_DP_HEADER)) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1911 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1912 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1913
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1914
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1915 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1916 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1917 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1918 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1919 | STATE : code ROUTINE : vsi_c_pmax_size |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1920 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1921
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1922 PURPOSE : get maximum number of bytes available for user data
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1923 in dynamic primitive
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1924
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1925 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1926 GLOBAL int vsi_c_pmax_size ( void )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1927 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1928 return ( (int)(MaxPrimPartSize - sizeof(T_DP_HEADER)) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1929 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1930 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1931
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1932 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1933 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1934 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1935 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1936 | STATE : code ROUTINE : vsi_c_sync |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1937 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1938
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1939 PURPOSE : check if PS already started
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1940
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1941 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1942 GLOBAL int vsi_c_sync ( T_HANDLE caller, T_TIME timeout )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1943 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1944 T_VOID_STRUCT *prim;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1945 T_QMSG Msg;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1946 T_HANDLE tst_q_handle;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1947 char sync_req_name[RESOURCE_NAMELEN];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1948 char sync_req_time[8];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1949 static int sync_active = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1950
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1951
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1952 if ( sync_active == FALSE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1953 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1954 sync_active = TRUE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1955 os_GetTaskName(caller, caller, sync_req_name);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1956 itoa(timeout, sync_req_time,10);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1957
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1958 prim = vsi_c_pnew ( sizeof(T_PRIM_HEADER)+strlen(SYSPRIM_CONFIG_TOKEN)+1
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1959 +strlen(SYSPRIM_TST_SYNC_REQ)+1
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1960 +strlen(sync_req_name)+1
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1961 +strlen(sync_req_time)+1, 0x8000 FILE_LINE );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1962 strcpy ( (char*)prim, SYSPRIM_CONFIG_TOKEN );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1963 strcat ( (char*)prim, " " );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1964 strcat ( (char*)prim, SYSPRIM_TST_SYNC_REQ );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1965 strcat ( (char*)prim, " " );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1966 strcat ( (char*)prim, sync_req_name );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1967 strcat ( (char*)prim, " " );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1968 strcat ( (char*)prim, sync_req_time );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1969
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1970 tst_q_handle = vsi_c_open ( caller, FRM_TST_NAME );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1971 vsi_c_psend ( tst_q_handle, prim );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1972
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1973 if ( vsi_c_await ( caller, pf_TaskTable[caller].QueueHandle, &Msg, timeout ) == VSI_TIMEOUT )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1974 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1975 vsi_o_ttrace (caller, TC_SYSTEM, "timeout - Synchronization with Stack failed" );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1976 sync_active = FALSE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1977 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1978 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1979 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1980 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1981 sync_active = FALSE;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1982 if ( strcmp ((char*)P2D(Msg.Msg.Primitive.Prim), SYSPRIM_TST_SYNC_CNF ) == 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1983 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1984 vsi_o_ttrace (caller, TC_SYSTEM, "TST_SYNC_CNF - Synchronization with Stack succeeded" );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1985 vsi_c_free (caller, &Msg.Msg.Primitive.Prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1986 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1987 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1988 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1989 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1990 vsi_o_ttrace (caller, TC_SYSTEM, "TST_SYNC_REJ - Synchronization with Stack failed" );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1991 vsi_c_free (caller, &Msg.Msg.Primitive.Prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1992 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1993 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1994 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1995 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1996 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1997 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1998 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
1999
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2000 #ifdef _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2001 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2002 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2003 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2004 | STATE : code ROUTINE : vsi_c_generic_send |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2005 +--------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2006
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2007 PURPOSE : check if PS already started
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2008
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2009 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2010 int vsi_c_alloc_send ( T_HANDLE com_handle, char* dst, char* src, void *prim, char *string )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2011 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2012 int alloc_size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2013 T_PRIM_HEADER *ptr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2014 T_S_HEADER *s_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2015 unsigned int i;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2016 unsigned int size;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2017 int opc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2018 int s_header_added = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2019 int sh_offset;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2020
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2021 if ( string != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2022 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2023 size = strlen(string);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2024 alloc_size = size + sizeof(T_PRIM_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2025 if ( dst != NULL || src != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2026 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2027 sh_offset = ALIGN(alloc_size) / (int)sizeof(ULONG);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2028 alloc_size = ALIGN(alloc_size) + sizeof(T_S_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2029 if ( dst != 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2030 opc = 0; /* to stack -> set to SYS_MASK in tst_pei_primitive() when sh_offset != 0 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2031 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2032 opc = SYS_MASK; /* to tools */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2033 s_header_added = 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2034 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2035 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2036 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2037 opc = SYS_MASK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2038 sh_offset = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2039 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2040 ptr = (T_PRIM_HEADER*)vsi_c_new ( 0, alloc_size, opc );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2041 memcpy ( (char*)P2D(ptr), string, size );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2042 if ( s_header_added == 1 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2043 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2044 ptr->sh_offset = sh_offset;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2045 s_hdr = (T_S_HEADER*)((int*)ptr+ptr->sh_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2046 ptr->len = size + sizeof(T_PRIM_HEADER); /* exclude S_HEADER */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2047 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2048 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2049 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2050 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2051 ptr = D2P(prim); /* work on passed primitive */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2052 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2053 if ( dst != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2054 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2055 if ( s_header_added == 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2056 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2057 alloc_size = ALIGN(ptr->len) + sizeof(T_S_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2058 ptr = (T_PRIM_HEADER*)vsi_c_new ( 0, alloc_size, 0 );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2059 memcpy((char*)ptr, (char*)D2P(prim), D_LEN(prim));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2060 ptr->sh_offset = ALIGN(D_LEN(prim)) / sizeof(ULONG);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2061 s_hdr = (T_S_HEADER*)((int*)ptr+ptr->sh_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2062 FREE(prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2063 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2064 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2065 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2066 s_hdr = (T_S_HEADER*)((int*)ptr+ptr->sh_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2067 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2068 /* set org_rcv and rcv */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2069 for (i = 0; dst[i] && i < sizeof (s_hdr->rcv) && dst[i]!= ';'; i++)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2070 s_hdr->org_rcv[i] = s_hdr->rcv[i] = dst[i];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2071 if (i < sizeof s_hdr->rcv)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2072 s_hdr->org_rcv[i] = s_hdr->rcv[i] = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2073
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2074 s_hdr->time = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2075 s_header_added = 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2076 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2077
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2078 if ( src != NULL )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2079 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2080 if ( s_header_added == 0 )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2081 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2082 alloc_size = ALIGN(ptr->len) + sizeof(T_S_HEADER);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2083 ptr = (T_PRIM_HEADER*)vsi_c_new ( 0, alloc_size, 0 );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2084 memcpy((char*)ptr, (char*)D2P(prim), D_LEN(prim));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2085 ptr->sh_offset = ALIGN(D_LEN(prim)) / sizeof(ULONG);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2086 s_hdr = (T_S_HEADER*)((int*)ptr+ptr->sh_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2087 FREE(prim);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2088 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2089 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2090 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2091 s_hdr = (T_S_HEADER*)((int*)ptr+ptr->sh_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2092 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2093
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2094 s_hdr->time = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2095
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2096 /* set snd */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2097 for (i = 0; src[i] && i < sizeof (s_hdr->snd) && src[i]!= ';'; i++)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2098 s_hdr->snd[i] = src[i];
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2099 if (i < sizeof s_hdr->snd)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2100 s_hdr->snd[i] = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2101 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2102
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2103 return ( vsi_c_psend (com_handle, (T_VOID_STRUCT*)P2D(ptr)) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2104 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2105 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2106
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2107 #ifdef NU_DEBUG
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2108 #ifndef RUN_FLASH
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2109 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2110 +----------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2111 | PROJECT : GSM-Frame (8415) MODULE : VSI_COM |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2112 | STATE : code ROUTINE : check_descriptor_list |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2113 +----------------------------------------------------------------------+
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2114
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2115 PURPOSE : check partitions in descriptor list
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2116
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2117 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2118 int check_descriptor_list ( T_HANDLE caller, T_PRIM_HEADER *prim FILE_LINE_TYPE )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2119 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2120 T_DP_HEADER *dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2121 T_M_HEADER *mem;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2122 T_desc *desc;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2123 LONG Status;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2124
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2125 dp_hdr = (T_DP_HEADER*)((ULONG*)prim + prim->dph_offset);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2126 /* the presence of the guard pattern at dph_offset is used to distinguish between dynamic primitives
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2127 and primitives with descriptor list. If the guard pattern is destroyed, the primitive looks like
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2128 having a descriptor list and the frame will probably crash during checking the integrity of the
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2129 partitions in the list. This bahavior is prefered to non checking the partitions */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2130
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2131 if ( *((ULONG*)dp_hdr) == GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2132 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2133 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2134 while (dp_hdr != NULL)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2135 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2136 if ( dp_hdr->magic_nr != GUARD_PATTERN )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2137 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2138 prim = (T_PRIM_HEADER*)dp_hdr;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2139 vsi_o_assert ( caller, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2140 "Magic number in dp_header destroyed (PSEND) %s , opc: 0x%lx, partition 0x%lx",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2141 pf_TaskTable[caller].Name, prim->opc, prim );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2142 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2143 if ( (Status = os_PartitionCheck ( (T_VOID_STRUCT*)dp_hdr)) == OS_PARTITION_GUARD_PATTERN_DESTROYED )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2144 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2145 vsi_o_assert ( caller, OS_SYST_ERR_PCB_PATTERN FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2146 "%s in dynamic primitive (PSEND),entity %s, prim 0x%x, opc 0x%x, bad partition 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2147 guard_str, pf_TaskTable[caller].Name, prim, prim->opc, dp_hdr );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2148 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2149 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2150 dp_hdr = (T_DP_HEADER*)dp_hdr->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2151 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2152 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2153 else
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2154 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2155 if ( caller != TST_Handle )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2156 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2157 /* do not check and update the states of the primitives in descriptor lists when called by TST, because
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2158 descriptor lists are not routed to TST and will result in the warning generated below */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2159 desc = (T_desc*)(((T_desc_list*)dp_hdr)->first);
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2160 while (desc != NULL)
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2161 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2162 mem = (T_M_HEADER*)(((char*)desc)-sizeof(T_M_HEADER));
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2163 if ( os_is_valid_partition ((T_VOID_STRUCT*)mem) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2164 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2165 vsi_o_assert ( NO_TASK, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2166 "pointer to non-partition memory in desc list(PSEND), entity %s, prim 0x%x, opc 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2167 pf_TaskTable[caller].Name, prim, prim->opc );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2168 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2169 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2170 if ( (Status = os_PartitionCheck ( (T_VOID_STRUCT*)mem)) != OS_OK )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2171 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2172 switch ( Status )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2173 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2174 case OS_PARTITION_GUARD_PATTERN_DESTROYED:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2175 vsi_o_assert ( caller, OS_SYST_ERR_PCB_PATTERN FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2176 "%s in desclist (PSEND), entity %s, prim 0x%x, opc 0x%x, bad partition 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2177 guard_str, pf_TaskTable[caller].Name, prim, prim->opc, mem );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2178 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2179 case OS_PARTITION_FREE:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2180 vsi_o_assert ( caller, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2181 "%s in desclist (PSEND), entity %s, prim 0x%x, opc 0x%x, freed partition 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2182 freed_sent_str, pf_TaskTable[caller].Name, prim, prim->opc, mem );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2183 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2184 default:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2185 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2186 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2187 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2188 if ( mem->desc_type == (VSI_DESC_TYPE3 >> 16) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2189 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2190 mem = ((T_M_HEADER*)(((T_desc3*)desc)->buffer)) - 1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2191 if ( os_is_valid_partition ( (T_VOID_STRUCT*)mem ) )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2192 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2193 vsi_o_assert ( NO_TASK, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2194 "pointer to non-partition memory in desc list type 3 (PSEND), entity %s, prim 0x%x, opc 0x%x, invalid partition 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2195 pf_TaskTable[caller].Name, prim, prim->opc, mem );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2196 return VSI_ERROR;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2197 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2198 if ( (Status = os_PartitionCheck ( (T_VOID_STRUCT*)mem )) != OS_OK )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2199 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2200 switch ( Status )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2201 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2202 case OS_PARTITION_GUARD_PATTERN_DESTROYED:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2203 vsi_o_assert ( caller, OS_SYST_ERR_PCB_PATTERN FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2204 "%s in desclist type 3 (PSEND), entity %s, prim 0x%x, opc 0x%x, bad partition 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2205 guard_str, pf_TaskTable[caller].Name, prim, prim->opc, mem );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2206 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2207 case OS_PARTITION_FREE:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2208 vsi_o_assert ( caller, OS_SYST_ERR FILE_LINE_MACRO_PASSED,
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2209 "%s in desclist type 3 (PSEND), entity %s, prim 0x%x, opc 0x%x, freed partition 0x%x",
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2210 freed_sent_str, pf_TaskTable[caller].Name, prim, prim->opc, mem );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2211 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2212 default:
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2213 break;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2214 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2215 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2216 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2217
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2218 desc = (T_desc *)desc->next;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2219 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2220 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2221 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2222 return VSI_OK;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2223 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2224 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2225 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2226
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2227 #if !defined _TARGET_ && !defined _TOOLS_
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2228
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2229 /* -------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2230 check functions
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2231 ----------------------------------------------------------------------------*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2232
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2233 #ifdef TEST_PCHECK
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2234
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2235 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2236 ULONG test_pcheck ( ULONG opc, void * decoded_prim )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2237 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2238 vsi_o_ttrace ( NO_TASK, TC_SYSTEM, "test_pcheck() called for opc %8x", D_OPC(decoded_prim) );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2239 return pcheck_func.ret_ok+1;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2240 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2241 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2242
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2243 #endif /* TEST_PCHECK */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2244
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2245 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2246 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2247 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2248 | Function : pcheck_register
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2249 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2250 | Description : register the pcheck function.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2251 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2252 | Parameters : func - pointer to API function pointer table
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2253 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2254 | Return : void
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2255 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2256 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2257 void vsi_pcheck_register ( ULONG (*func)(ULONG, void*), ULONG ret_ok )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2258 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2259 pcheck_func.ret_ok = ret_ok;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2260 pcheck_func.pcheck = func;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2261 pcheck_func.magic_nr = PCHECK_INITIALIZED;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2262 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2263 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2264
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2265 #ifndef RUN_INT_RAM
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2266 /*
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2267 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2268 | Function : ext_trace_init
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2269 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2270 | Description : initialize external trace function pointer table.
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2271 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2272 | Parameters : void
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2273 |
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2274 | Return : void
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2275 +------------------------------------------------------------------------------
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2276 */
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2277 void vsi_pcheck_init ( void )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2278 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2279 #ifdef TEST_PCHECK
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2280 vsi_pcheck_register ( test_pcheck, 0 );
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2281 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2282 if ( pcheck_func.magic_nr != PCHECK_INITIALIZED )
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2283 {
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2284 pcheck_func.ret_ok = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2285 pcheck_func.pcheck = NULL;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2286 pcheck_func.magic_nr = 0;
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2287 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2288 }
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2289 #endif
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2290
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2291 #endif /* !_TARGET_ && !_TOOLS_*/
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2292
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2293
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2294
|
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff
changeset
|
2295
|
