FreeCalypso > hg > freecalypso-sw
comparison nuc-fw/nucleus/pmc.c @ 79:947b1f473960
beginning of nuc-fw
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Sun, 11 Aug 2013 07:17:25 +0000 |
parents | |
children |
comparison
equal
deleted
inserted
replaced
78:2c266d4339ff | 79:947b1f473960 |
---|---|
1 /*************************************************************************/ | |
2 /* */ | |
3 /* Copyright Mentor Graphics Corporation 2002 */ | |
4 /* All Rights Reserved. */ | |
5 /* */ | |
6 /* THIS WORK CONTAINS TRADE SECRET AND PROPRIETARY INFORMATION WHICH IS */ | |
7 /* THE PROPERTY OF MENTOR GRAPHICS CORPORATION OR ITS LICENSORS AND IS */ | |
8 /* SUBJECT TO LICENSE TERMS. */ | |
9 /* */ | |
10 /*************************************************************************/ | |
11 | |
12 /*************************************************************************/ | |
13 /* */ | |
14 /* FILE NAME VERSION */ | |
15 /* */ | |
16 /* pmc.c Nucleus PLUS 1.14 */ | |
17 /* */ | |
18 /* COMPONENT */ | |
19 /* */ | |
20 /* PM - Partition Memory Management */ | |
21 /* */ | |
22 /* DESCRIPTION */ | |
23 /* */ | |
24 /* This file contains the core routines for the Partition Memory */ | |
25 /* Management component. */ | |
26 /* */ | |
27 /* DATA STRUCTURES */ | |
28 /* */ | |
29 /* None */ | |
30 /* */ | |
31 /* FUNCTIONS */ | |
32 /* */ | |
33 /* PMC_Create_Partition_Pool Create a Partition Pool */ | |
34 /* PMC_Delete_Partition_Pool Delete a Partition Pool */ | |
35 /* PMC_Allocate_Partition Allocate a partition from a */ | |
36 /* pool */ | |
37 /* PMC_Deallocate_Partition Deallocate a partition from */ | |
38 /* a pool */ | |
39 /* PMC_Cleanup Cleanup on timeout or a */ | |
40 /* terminate condition */ | |
41 /* */ | |
42 /* DEPENDENCIES */ | |
43 /* */ | |
44 /* cs_extr.h Common Service functions */ | |
45 /* tc_extr.h Thread Control functions */ | |
46 /* pm_extr.h Partition functions */ | |
47 /* hi_extr.h History functions */ | |
48 /* */ | |
49 /* HISTORY */ | |
50 /* */ | |
51 /* DATE REMARKS */ | |
52 /* */ | |
53 /* 03-01-1993 Created initial version 1.0 */ | |
54 /* 04-19-1993 Verified version 1.0 */ | |
55 /* 08-09-1993 Corrected pointer retrieval */ | |
56 /* loop, resulting in version 1.0a */ | |
57 /* 08-09-1993 Verified version 1.0a */ | |
58 /* 03-01-1994 Moved non-core functions into */ | |
59 /* supplemental files, changed */ | |
60 /* function interfaces to match */ | |
61 /* those in prototype, added */ | |
62 /* register options, changed */ | |
63 /* protection logic to reduce */ | |
64 /* overhead, resulting in */ | |
65 /* version 1.1 */ | |
66 /* */ | |
67 /* 03-18-1994 Verified version 1.1 */ | |
68 /* 04-17-1996 updated to version 1.2 */ | |
69 /* 03-24-1998 Released version 1.3 */ | |
70 /* 03-26-1999 Released 1.11m (new release */ | |
71 /* numbering scheme) */ | |
72 /* 04-17-2002 Released version 1.13m */ | |
73 /* 11-07-2002 Released version 1.14 */ | |
74 /*************************************************************************/ | |
75 #define NU_SOURCE_FILE | |
76 | |
77 | |
78 #include "cs_extr.h" /* Common service functions */ | |
79 #include "tc_extr.h" /* Thread control functions */ | |
80 #include "pm_extr.h" /* Partition functions */ | |
81 #include "hi_extr.h" /* History functions */ | |
82 #include "profiler.h" /* ProView interface */ | |
83 | |
84 | |
85 /* Define external inner-component global data references. */ | |
86 | |
87 extern CS_NODE *PMD_Created_Pools_List; | |
88 extern UNSIGNED PMD_Total_Pools; | |
89 extern TC_PROTECT PMD_List_Protect; | |
90 | |
91 | |
92 /* Define internal component function prototypes. */ | |
93 | |
94 VOID PMC_Cleanup(VOID *information); | |
95 | |
96 | |
97 /*************************************************************************/ | |
98 /* */ | |
99 /* FUNCTION */ | |
100 /* */ | |
101 /* PMC_Create_Partition_Pool */ | |
102 /* */ | |
103 /* DESCRIPTION */ | |
104 /* */ | |
105 /* This function creates a memory partition pool and then places it */ | |
106 /* on the list of created partition pools. */ | |
107 /* */ | |
108 /* CALLED BY */ | |
109 /* */ | |
110 /* Application */ | |
111 /* PMCE_Create_Partition_Pool Error checking shell */ | |
112 /* */ | |
113 /* CALLS */ | |
114 /* */ | |
115 /* CSC_Place_On_List Add node to linked-list */ | |
116 /* [HIC_Make_History_Entry] Make entry in history log */ | |
117 /* [TCT_Check_Stack] Stack checking function */ | |
118 /* TCT_Protect Data structure protect */ | |
119 /* TCT_Unprotect Un-protect data structure */ | |
120 /* */ | |
121 /* INPUTS */ | |
122 /* */ | |
123 /* pool_ptr Partition pool control block */ | |
124 /* pointer */ | |
125 /* name Partition pool name */ | |
126 /* start_address Starting address of the pool */ | |
127 /* pool_size Number of bytes in the pool */ | |
128 /* partition_size Number of bytes in each */ | |
129 /* partition of the pool */ | |
130 /* suspend_type Suspension type */ | |
131 /* */ | |
132 /* OUTPUTS */ | |
133 /* */ | |
134 /* NU_SUCCESS */ | |
135 /* */ | |
136 /* HISTORY */ | |
137 /* */ | |
138 /* DATE REMARKS */ | |
139 /* */ | |
140 /* 03-01-1993 Created initial version 1.0 */ | |
141 /* 04-19-1993 Verified version 1.0 */ | |
142 /* 03-01-1994 Changed function interfaces to */ | |
143 /* match those in prototype, */ | |
144 /* added register options, */ | |
145 /* resulting in version 1.1 */ | |
146 /* */ | |
147 /* 03-18-1994 Verified version 1.1 */ | |
148 /* */ | |
149 /*************************************************************************/ | |
150 STATUS PMC_Create_Partition_Pool(NU_PARTITION_POOL *pool_ptr, CHAR *name, | |
151 VOID *start_address, UNSIGNED pool_size, | |
152 UNSIGNED partition_size, OPTION suspend_type) | |
153 { | |
154 | |
155 R1 PM_PCB *pool; /* Pool control block ptr */ | |
156 INT i; /* Working index variable */ | |
157 BYTE_PTR pointer; /* Working byte pointer */ | |
158 PM_HEADER *header_ptr; /* Partition block header ptr*/ | |
159 NU_SUPERV_USER_VARIABLES | |
160 | |
161 /* Switch to supervisor mode */ | |
162 NU_SUPERVISOR_MODE(); | |
163 | |
164 /* Move input pool pointer into internal pointer. */ | |
165 pool = (PM_PCB *) pool_ptr; | |
166 | |
167 | |
168 #ifdef NU_ENABLE_STACK_CHECK | |
169 | |
170 /* Call stack checking function to check for an overflow condition. */ | |
171 TCT_Check_Stack(); | |
172 | |
173 #endif | |
174 | |
175 #ifdef NU_ENABLE_HISTORY | |
176 | |
177 /* Make an entry that corresponds to this function in the system history | |
178 log. */ | |
179 HIC_Make_History_Entry(NU_CREATE_PARTITION_POOL_ID, (UNSIGNED) pool, | |
180 (UNSIGNED) name, (UNSIGNED) start_address); | |
181 | |
182 #endif | |
183 | |
184 /* First, clear the partition pool ID just in case it is an old | |
185 pool control block. */ | |
186 pool -> pm_id = 0; | |
187 | |
188 /* Fill in the partition pool name. */ | |
189 for (i = 0; i < NU_MAX_NAME; i++) | |
190 pool -> pm_name[i] = name[i]; | |
191 | |
192 /* Save the starting address and size parameters in the partition control | |
193 block. */ | |
194 pool -> pm_start_address = start_address; | |
195 pool -> pm_pool_size = pool_size; | |
196 pool -> pm_partition_size = partition_size; | |
197 | |
198 /* Setup the partition pool suspension type. */ | |
199 if (suspend_type == NU_FIFO) | |
200 | |
201 /* FIFO suspension is selected, setup the flag accordingly. */ | |
202 pool -> pm_fifo_suspend = NU_TRUE; | |
203 else | |
204 | |
205 /* Priority suspension is selected. */ | |
206 pool -> pm_fifo_suspend = NU_FALSE; | |
207 | |
208 /* Clear the suspension list pointer. */ | |
209 pool -> pm_suspension_list = NU_NULL; | |
210 | |
211 /* Clear the number of tasks waiting on the partition pool. */ | |
212 pool -> pm_tasks_waiting = 0; | |
213 | |
214 /* Initialize link pointers. */ | |
215 pool -> pm_created.cs_previous = NU_NULL; | |
216 pool -> pm_created.cs_next = NU_NULL; | |
217 | |
218 /* Initialize the partition parameters. */ | |
219 pool -> pm_available = 0; | |
220 pool -> pm_allocated = 0; | |
221 pool -> pm_available_list = NU_NULL; | |
222 | |
223 /* Convert the supplied partition size into something that is evenly | |
224 divisible by the sizeof an UNSIGNED data element. This insures | |
225 UNSIGNED alignment. */ | |
226 partition_size = | |
227 ((partition_size + sizeof(UNSIGNED) - 1)/sizeof(UNSIGNED)) * | |
228 sizeof(UNSIGNED); | |
229 | |
230 /* Loop to build and link as many partitions as possible from within the | |
231 specified memory area. */ | |
232 pointer = (BYTE_PTR) start_address; | |
233 while (pool_size >= (PM_OVERHEAD + partition_size)) | |
234 { | |
235 | |
236 /* There is room for another partition. */ | |
237 | |
238 /* Cast the current pointer variable to a header pointer. */ | |
239 header_ptr = (PM_HEADER *) pointer; | |
240 | |
241 /* Now, build a header and link it into the partition pool | |
242 available list- at the front. */ | |
243 header_ptr -> pm_partition_pool = pool; | |
244 header_ptr -> pm_next_available = pool -> pm_available_list; | |
245 pool -> pm_available_list = header_ptr; | |
246 | |
247 /* Increment the number of partitions available in the pool. */ | |
248 pool -> pm_available++; | |
249 | |
250 /* Decrement the number of bytes remaining in the pool. */ | |
251 pool_size = pool_size - (PM_OVERHEAD + partition_size); | |
252 | |
253 /* Increment the working pointer to the next partition position. */ | |
254 pointer = pointer + (PM_OVERHEAD + partition_size); | |
255 } | |
256 | |
257 /* Protect against access to the list of created partition pools. */ | |
258 TCT_Protect(&PMD_List_Protect); | |
259 | |
260 /* At this point the partition pool is completely built. The ID can | |
261 now be set and it can be linked into the created partition pool list. */ | |
262 pool -> pm_id = PM_PARTITION_ID; | |
263 | |
264 /* Link the partition pool into the list of created partition pools and | |
265 increment the total number of pools in the system. */ | |
266 CSC_Place_On_List(&PMD_Created_Pools_List, &(pool -> pm_created)); | |
267 PMD_Total_Pools++; | |
268 | |
269 #ifdef INCLUDE_PROVIEW | |
270 _RTProf_DumpPartitionPool(RT_PROF_CREATE_PARTITION_POOL,pool,RT_PROF_OK); | |
271 #endif /* INCLUDE_PROVIEW */ | |
272 /* Release protection against access to the list of created partition | |
273 pools. */ | |
274 TCT_Unprotect(); | |
275 | |
276 /* Return to user mode */ | |
277 NU_USER_MODE(); | |
278 | |
279 /* Return successful completion. */ | |
280 return(NU_SUCCESS); | |
281 } | |
282 | |
283 | |
284 /*************************************************************************/ | |
285 /* */ | |
286 /* FUNCTION */ | |
287 /* */ | |
288 /* PMC_Delete_Partition_Pool */ | |
289 /* */ | |
290 /* DESCRIPTION */ | |
291 /* */ | |
292 /* This function deletes a memory partition pool and removes it from*/ | |
293 /* the list of created partition pools. All tasks suspended on the */ | |
294 /* partition pool are resumed with the appropriate error status. */ | |
295 /* Note that this function does not free any memory associated with */ | |
296 /* either the pool area or the pool control block. */ | |
297 /* */ | |
298 /* CALLED BY */ | |
299 /* */ | |
300 /* Application */ | |
301 /* PMCE_Delete_Partition_Pool Error checking shell */ | |
302 /* */ | |
303 /* CALLS */ | |
304 /* */ | |
305 /* CSC_Remove_From_List Remove node from list */ | |
306 /* [HIC_Make_History_Entry] Make entry in history log */ | |
307 /* TCC_Resume_Task Resume a suspended task */ | |
308 /* [TCT_Check_Stack] Stack checking function */ | |
309 /* TCT_Control_To_System Transfer control to system */ | |
310 /* TCT_Protect Protect created list */ | |
311 /* TCT_Set_Current_Protect Modify current protection */ | |
312 /* TCT_System_Protect Setup system protection */ | |
313 /* TCT_System_Unprotect Release system protection */ | |
314 /* TCT_Unprotect Release protection */ | |
315 /* */ | |
316 /* INPUTS */ | |
317 /* */ | |
318 /* pool_ptr Partition pool control block */ | |
319 /* pointer */ | |
320 /* */ | |
321 /* OUTPUTS */ | |
322 /* */ | |
323 /* NU_SUCCESS */ | |
324 /* */ | |
325 /* HISTORY */ | |
326 /* */ | |
327 /* DATE REMARKS */ | |
328 /* */ | |
329 /* 03-01-1993 Created initial version 1.0 */ | |
330 /* 04-19-1993 Verified version 1.0 */ | |
331 /* 03-01-1994 Changed function interfaces to */ | |
332 /* match those in prototype, */ | |
333 /* added register options, changed */ | |
334 /* protection logic to reduce */ | |
335 /* overhead, resulting in */ | |
336 /* version 1.1 */ | |
337 /* */ | |
338 /* 03-18-1994 Verified version 1.1 */ | |
339 /* */ | |
340 /*************************************************************************/ | |
341 STATUS PMC_Delete_Partition_Pool(NU_PARTITION_POOL *pool_ptr) | |
342 { | |
343 | |
344 R1 PM_PCB *pool; /* Pool control block ptr */ | |
345 PM_SUSPEND *suspend_ptr; /* Suspend block pointer */ | |
346 PM_SUSPEND *next_ptr; /* Next suspend block */ | |
347 STATUS preempt; /* Status for resume call */ | |
348 NU_SUPERV_USER_VARIABLES | |
349 | |
350 /* Switch to supervisor mode */ | |
351 NU_SUPERVISOR_MODE(); | |
352 | |
353 /* Move input pool pointer into internal pointer. */ | |
354 pool = (PM_PCB *) pool_ptr; | |
355 | |
356 | |
357 #ifdef NU_ENABLE_STACK_CHECK | |
358 | |
359 /* Call stack checking function to check for an overflow condition. */ | |
360 TCT_Check_Stack(); | |
361 | |
362 #endif | |
363 | |
364 #ifdef NU_ENABLE_HISTORY | |
365 | |
366 /* Make an entry that corresponds to this function in the system history | |
367 log. */ | |
368 HIC_Make_History_Entry(NU_DELETE_PARTITION_POOL_ID, (UNSIGNED) pool, | |
369 (UNSIGNED) 0, (UNSIGNED) 0); | |
370 | |
371 #endif | |
372 | |
373 /* Protect against simultaneous access to the partition pool. */ | |
374 TCT_System_Protect(); | |
375 | |
376 #ifdef INCLUDE_PROVIEW | |
377 _RTProf_DumpPartitionPool(RT_PROF_DELETE_PARTITION_POOL,pool,RT_PROF_OK); | |
378 #endif /* INCLUDE_PROVIEW */ | |
379 | |
380 /* Clear the partition pool ID. */ | |
381 pool -> pm_id = 0; | |
382 | |
383 /* Release protection. */ | |
384 TCT_Unprotect(); | |
385 | |
386 /* Protect against access to the list of created partition pools. */ | |
387 TCT_Protect(&PMD_List_Protect); | |
388 | |
389 /* Remove the partition pool from the list of created partition pools. */ | |
390 CSC_Remove_From_List(&PMD_Created_Pools_List, &(pool -> pm_created)); | |
391 | |
392 /* Decrement the total number of created partition pools. */ | |
393 PMD_Total_Pools--; | |
394 | |
395 /* Pickup the suspended task pointer list. */ | |
396 suspend_ptr = pool -> pm_suspension_list; | |
397 | |
398 /* Walk the chain task(s) currently suspended on the partition pool. */ | |
399 preempt = 0; | |
400 while (suspend_ptr) | |
401 { | |
402 | |
403 /* Protect against system access. */ | |
404 TCT_System_Protect(); | |
405 | |
406 /* Resume the suspended task. Insure that the status returned is | |
407 NU_POOL_DELETED. */ | |
408 suspend_ptr -> pm_return_pointer = NU_NULL; | |
409 suspend_ptr -> pm_return_status = NU_POOL_DELETED; | |
410 | |
411 /* Point to the next suspend structure in the link. */ | |
412 next_ptr = (PM_SUSPEND *) (suspend_ptr -> pm_suspend_link.cs_next); | |
413 | |
414 /* Resume the specified task. */ | |
415 preempt = preempt | | |
416 TCC_Resume_Task((NU_TASK *) suspend_ptr -> pm_suspended_task, | |
417 NU_PARTITION_SUSPEND); | |
418 | |
419 /* Determine if the next is the same as the current pointer. */ | |
420 if (next_ptr == pool -> pm_suspension_list) | |
421 | |
422 /* Clear the suspension pointer to signal the end of the list | |
423 traversal. */ | |
424 suspend_ptr = NU_NULL; | |
425 else | |
426 | |
427 /* Move the next pointer into the suspend block pointer. */ | |
428 suspend_ptr = next_ptr; | |
429 | |
430 /* Modify current protection. */ | |
431 TCT_Set_Current_Protect(&PMD_List_Protect); | |
432 | |
433 /* Clear the system protection. */ | |
434 TCT_System_Unprotect(); | |
435 } | |
436 | |
437 /* Determine if preemption needs to occur. */ | |
438 if (preempt) | |
439 | |
440 /* Transfer control to system to facilitate preemption. */ | |
441 TCT_Control_To_System(); | |
442 | |
443 /* Release protection against access to the list of created partition | |
444 pools. */ | |
445 TCT_Unprotect(); | |
446 | |
447 /* Return to user mode */ | |
448 NU_USER_MODE(); | |
449 | |
450 /* Return a successful completion. */ | |
451 return(NU_SUCCESS); | |
452 } | |
453 | |
454 | |
455 /*************************************************************************/ | |
456 /* */ | |
457 /* FUNCTION */ | |
458 /* */ | |
459 /* PMC_Allocate_Partition */ | |
460 /* */ | |
461 /* DESCRIPTION */ | |
462 /* */ | |
463 /* This function allocates a memory partition from the specified */ | |
464 /* memory partition pool. If a memory partition is currently */ | |
465 /* available, this function is completed immediately. Otherwise, */ | |
466 /* if there are no partitions currently available, suspension is */ | |
467 /* possible. */ | |
468 /* */ | |
469 /* CALLED BY */ | |
470 /* */ | |
471 /* Application */ | |
472 /* PMCE_Allocate_Partition Error checking shell */ | |
473 /* */ | |
474 /* CALLS */ | |
475 /* */ | |
476 /* CSC_Place_On_List Place on suspend list */ | |
477 /* CSC_Priority_Place_On_List Place on priority list */ | |
478 /* [HIC_Make_History_Entry] Make entry in history log */ | |
479 /* TCC_Suspend_Task Suspend calling task */ | |
480 /* TCC_Task_Priority Pickup task's priority */ | |
481 /* [TCT_Check_Stack] Stack checking function */ | |
482 /* TCT_Current_Thread Pickup current thread pointer*/ | |
483 /* TCT_System_Protect Protect partition pool */ | |
484 /* TCT_Unprotect Release protection */ | |
485 /* */ | |
486 /* INPUTS */ | |
487 /* */ | |
488 /* pool_ptr Memory partition pool pointer*/ | |
489 /* return_pointer Pointer to the destination */ | |
490 /* memory pointer */ | |
491 /* suspend Suspension option if full */ | |
492 /* */ | |
493 /* OUTPUTS */ | |
494 /* */ | |
495 /* NU_SUCCESS If service is successful */ | |
496 /* NU_NO_PARTITION No partitions are available */ | |
497 /* NU_TIMEOUT If timeout on service */ | |
498 /* NU_POOL_DELETED If partition pool deleted */ | |
499 /* during suspension */ | |
500 /* */ | |
501 /* HISTORY */ | |
502 /* */ | |
503 /* DATE REMARKS */ | |
504 /* */ | |
505 /* 03-01-1993 Created initial version 1.0 */ | |
506 /* 04-19-1993 Verified version 1.0 */ | |
507 /* 03-01-1994 Changed function interfaces to */ | |
508 /* match those in prototype, */ | |
509 /* added register options, changed */ | |
510 /* protection logic to reduce */ | |
511 /* overhead, resulting in */ | |
512 /* version 1.1 */ | |
513 /* */ | |
514 /* 03-18-1994 Verified version 1.1 */ | |
515 /* */ | |
516 /*************************************************************************/ | |
517 STATUS PMC_Allocate_Partition(NU_PARTITION_POOL *pool_ptr, | |
518 VOID **return_pointer, UNSIGNED suspend) | |
519 { | |
520 | |
521 R1 PM_PCB *pool; /* Pool control block ptr */ | |
522 R2 PM_SUSPEND *suspend_ptr; /* Suspend block pointer */ | |
523 PM_SUSPEND suspend_block; /* Allocate suspension block */ | |
524 R3 PM_HEADER *partition_ptr; /* Pointer to partition */ | |
525 TC_TCB *task; /* Task pointer */ | |
526 STATUS status; /* Completion status */ | |
527 NU_SUPERV_USER_VARIABLES | |
528 | |
529 /* Switch to supervisor mode */ | |
530 NU_SUPERVISOR_MODE(); | |
531 | |
532 /* Move input pool pointer into internal pointer. */ | |
533 pool = (PM_PCB *) pool_ptr; | |
534 | |
535 | |
536 #ifdef NU_ENABLE_STACK_CHECK | |
537 | |
538 /* Call stack checking function to check for an overflow condition. */ | |
539 TCT_Check_Stack(); | |
540 | |
541 #endif | |
542 | |
543 #ifdef NU_ENABLE_HISTORY | |
544 | |
545 /* Make an entry that corresponds to this function in the system history | |
546 log. */ | |
547 HIC_Make_History_Entry(NU_ALLOCATE_PARTITION_ID, (UNSIGNED) pool, | |
548 (UNSIGNED) return_pointer, (UNSIGNED) suspend); | |
549 | |
550 #endif | |
551 | |
552 /* Initialize the status as successful. */ | |
553 status = NU_SUCCESS; | |
554 | |
555 /* Protect against simultaneous access to the partition pool. */ | |
556 TCT_System_Protect(); | |
557 | |
558 /* Determine if there is an available memory partition. */ | |
559 if (pool -> pm_available) | |
560 { | |
561 | |
562 /* Partition available. */ | |
563 | |
564 /* Decrement the available count. */ | |
565 pool -> pm_available--; | |
566 | |
567 /* Increment the allocated count. */ | |
568 pool -> pm_allocated++; | |
569 | |
570 /* Unlink the first memory partition and return the pointer to the | |
571 caller. */ | |
572 partition_ptr = pool -> pm_available_list; | |
573 pool -> pm_available_list = partition_ptr -> pm_next_available; | |
574 partition_ptr -> pm_next_available = NU_NULL; | |
575 | |
576 /* Return a memory address to the caller. */ | |
577 *return_pointer = (VOID *) (((BYTE_PTR) partition_ptr) + PM_OVERHEAD); | |
578 | |
579 #ifdef INCLUDE_PROVIEW | |
580 _RTProf_DumpPartitionPool(RT_PROF_ALLOCATE_PARTITION,pool,RT_PROF_OK); | |
581 #endif /* INCLUDE_PROVIEW */ | |
582 | |
583 } | |
584 else | |
585 { | |
586 | |
587 /* A partition is not available. Determine if suspension is | |
588 required. */ | |
589 if (suspend) | |
590 { | |
591 | |
592 /* Suspension is selected. */ | |
593 | |
594 /* Increment the number of tasks waiting. */ | |
595 pool -> pm_tasks_waiting++; | |
596 | |
597 #ifdef INCLUDE_PROVIEW | |
598 _RTProf_DumpPartitionPool(RT_PROF_ALLOCATE_PARTITION,pool,RT_PROF_WAIT); | |
599 #endif /* INCLUDE_PROVIEW */ | |
600 /* Setup the suspend block and suspend the calling task. */ | |
601 suspend_ptr = &suspend_block; | |
602 suspend_ptr -> pm_partition_pool = pool; | |
603 suspend_ptr -> pm_suspend_link.cs_next = NU_NULL; | |
604 suspend_ptr -> pm_suspend_link.cs_previous = NU_NULL; | |
605 task = (TC_TCB *) TCT_Current_Thread(); | |
606 suspend_ptr -> pm_suspended_task = task; | |
607 | |
608 /* Determine if priority or FIFO suspension is associated with the | |
609 partition pool. */ | |
610 if (pool -> pm_fifo_suspend) | |
611 { | |
612 | |
613 /* FIFO suspension is required. Link the suspend block into | |
614 the list of suspended tasks on this partition pool. */ | |
615 CSC_Place_On_List((CS_NODE **) | |
616 &(pool -> pm_suspension_list), | |
617 &(suspend_ptr -> pm_suspend_link)); | |
618 } | |
619 else | |
620 { | |
621 | |
622 /* Get the priority of the current thread so the suspend block | |
623 can be placed in the appropriate place. */ | |
624 suspend_ptr -> pm_suspend_link.cs_priority = | |
625 TCC_Task_Priority(task); | |
626 | |
627 CSC_Priority_Place_On_List((CS_NODE **) | |
628 &(pool -> pm_suspension_list), | |
629 &(suspend_ptr -> pm_suspend_link)); | |
630 } | |
631 | |
632 /* Finally, suspend the calling task. Note that the suspension call | |
633 automatically clears the protection on the partition pool. */ | |
634 TCC_Suspend_Task((NU_TASK *) task, NU_PARTITION_SUSPEND, | |
635 PMC_Cleanup, suspend_ptr, suspend); | |
636 | |
637 /* Pickup the return status. */ | |
638 status = suspend_ptr -> pm_return_status; | |
639 *return_pointer = suspend_ptr -> pm_return_pointer; | |
640 } | |
641 else | |
642 { | |
643 /* No suspension requested. Simply return an error status. */ | |
644 status = NU_NO_PARTITION; | |
645 | |
646 #ifdef INCLUDE_PROVIEW | |
647 _RTProf_DumpPartitionPool(RT_PROF_ALLOCATE_PARTITION,pool,RT_PROF_FAIL); | |
648 #endif /* INCLUDE_PROVIEW */ | |
649 } | |
650 } | |
651 | |
652 /* Release protection of the partition pool. */ | |
653 TCT_Unprotect(); | |
654 | |
655 /* Return to user mode */ | |
656 NU_USER_MODE(); | |
657 | |
658 /* Return the completion status. */ | |
659 return(status); | |
660 } | |
661 | |
662 | |
663 /*************************************************************************/ | |
664 /* */ | |
665 /* FUNCTION */ | |
666 /* */ | |
667 /* PMC_Deallocate_Partition */ | |
668 /* */ | |
669 /* DESCRIPTION */ | |
670 /* */ | |
671 /* This function deallocates a previously allocated partition. If */ | |
672 /* there is a task waiting for a partition, the partition is simply */ | |
673 /* given to the waiting task and the waiting task is resumed. */ | |
674 /* Otherwise, the partition is returned to the partition pool. */ | |
675 /* */ | |
676 /* CALLED BY */ | |
677 /* */ | |
678 /* Application */ | |
679 /* PMCE_Deallocate_Partition Error checking shell */ | |
680 /* */ | |
681 /* CALLS */ | |
682 /* */ | |
683 /* CSC_Remove_From_List Remove from suspend list */ | |
684 /* [HIC_Make_History_Entry] Make entry in history log */ | |
685 /* TCC_Resume_Task Resume a suspended task */ | |
686 /* [TCT_Check_Stack] Stack checking function */ | |
687 /* TCT_Control_To_System Transfer control to system */ | |
688 /* TCT_System_Protect Protect partition pool */ | |
689 /* TCT_Unprotect Release protection */ | |
690 /* */ | |
691 /* INPUTS */ | |
692 /* */ | |
693 /* partition Pointer to partition memory */ | |
694 /* */ | |
695 /* OUTPUTS */ | |
696 /* */ | |
697 /* NU_SUCCESS */ | |
698 /* */ | |
699 /* HISTORY */ | |
700 /* */ | |
701 /* DATE REMARKS */ | |
702 /* */ | |
703 /* 03-01-1993 Created initial version 1.0 */ | |
704 /* 04-19-1993 Verified version 1.0 */ | |
705 /* 03-01-1994 Added register options, changed */ | |
706 /* protection logic to reduce */ | |
707 /* overhead, resulting in */ | |
708 /* version 1.1 */ | |
709 /* */ | |
710 /* 03-18-1994 Verified version 1.1 */ | |
711 /* */ | |
712 /*************************************************************************/ | |
713 STATUS PMC_Deallocate_Partition(VOID *partition) | |
714 { | |
715 | |
716 R1 PM_PCB *pool; /* Pool pointer */ | |
717 R3 PM_SUSPEND *suspend_ptr; /* Pointer to suspend block */ | |
718 R2 PM_HEADER *header_ptr; /* Pointer to partition hdr */ | |
719 STATUS preempt; /* Preemption flag */ | |
720 STATUS status; /* Completion status */ | |
721 NU_SUPERV_USER_VARIABLES | |
722 | |
723 /* Switch to supervisor mode */ | |
724 NU_SUPERVISOR_MODE(); | |
725 | |
726 #ifdef NU_ENABLE_STACK_CHECK | |
727 | |
728 /* Call stack checking function to check for an overflow condition. */ | |
729 TCT_Check_Stack(); | |
730 | |
731 #endif | |
732 | |
733 #ifdef NU_ENABLE_HISTORY | |
734 | |
735 /* Make an entry that corresponds to this function in the system history | |
736 log. */ | |
737 HIC_Make_History_Entry(NU_DEALLOCATE_PARTITION_ID, (UNSIGNED) partition, | |
738 (UNSIGNED) 0, (UNSIGNED) 0); | |
739 | |
740 #endif | |
741 | |
742 /* Initialize the status as successful. */ | |
743 status = NU_SUCCESS; | |
744 | |
745 /* Pickup the associated pool's pointer. It is inside the header of | |
746 each partition. */ | |
747 header_ptr = (PM_HEADER *) (((BYTE_PTR) partition) - PM_OVERHEAD); | |
748 pool = header_ptr -> pm_partition_pool; | |
749 | |
750 /* Protect against simultaneous access to the partition pool. */ | |
751 TCT_System_Protect(); | |
752 | |
753 /* Determine if another task is waiting for a partition from the pool. */ | |
754 if (pool -> pm_tasks_waiting) | |
755 { | |
756 | |
757 /* Yes, another task is waiting for a partition from the pool. */ | |
758 | |
759 /* Decrement the number of tasks waiting counter. */ | |
760 pool -> pm_tasks_waiting--; | |
761 | |
762 #ifdef INCLUDE_PROVIEW | |
763 _RTProf_DumpPartitionPool(RT_PROF_DEALLOCATE_PARTITION,pool,RT_PROF_OK); | |
764 #endif /* INCLUDE_PROVIEW */ | |
765 | |
766 /* Remove the first suspended block from the list. */ | |
767 suspend_ptr = pool -> pm_suspension_list; | |
768 CSC_Remove_From_List((CS_NODE **) &(pool -> pm_suspension_list), | |
769 &(suspend_ptr -> pm_suspend_link)); | |
770 | |
771 /* Setup the appropriate return value. */ | |
772 suspend_ptr -> pm_return_status = NU_SUCCESS; | |
773 suspend_ptr -> pm_return_pointer = partition; | |
774 | |
775 /* Resume the suspended task. */ | |
776 preempt = | |
777 TCC_Resume_Task((NU_TASK *) suspend_ptr -> pm_suspended_task, | |
778 NU_PARTITION_SUSPEND); | |
779 | |
780 /* Determine if a preempt condition is present. */ | |
781 if (preempt) | |
782 | |
783 /* Transfer control to the system if the resumed task function | |
784 detects a preemption condition. */ | |
785 TCT_Control_To_System(); | |
786 } | |
787 else | |
788 { | |
789 | |
790 /* Increment the available partitions counter. */ | |
791 pool -> pm_available++; | |
792 | |
793 /* Decrement the allocated partitions counter. */ | |
794 pool -> pm_allocated--; | |
795 | |
796 /* Place the partition back on the available list. */ | |
797 header_ptr -> pm_next_available = pool -> pm_available_list; | |
798 pool -> pm_available_list = header_ptr; | |
799 | |
800 #ifdef INCLUDE_PROVIEW | |
801 _RTProf_DumpPartitionPool(RT_PROF_DEALLOCATE_PARTITION,pool,RT_PROF_OK); | |
802 #endif /* INCLUDE_PROVIEW */ | |
803 | |
804 } | |
805 | |
806 /* Release protection of the partition pool. */ | |
807 TCT_Unprotect(); | |
808 | |
809 /* Return to user mode */ | |
810 NU_USER_MODE(); | |
811 | |
812 /* Return the completion status. */ | |
813 return(status); | |
814 } | |
815 | |
816 | |
817 /*************************************************************************/ | |
818 /* */ | |
819 /* FUNCTION */ | |
820 /* */ | |
821 /* PMC_Cleanup */ | |
822 /* */ | |
823 /* DESCRIPTION */ | |
824 /* */ | |
825 /* This function is responsible for removing a suspension block */ | |
826 /* from a partition pool. It is not called unless a timeout or */ | |
827 /* a task terminate is in progress. Note that protection is */ | |
828 /* already in effect - the same protection at suspension time. */ | |
829 /* */ | |
830 /* CALLED BY */ | |
831 /* */ | |
832 /* TCC_Timeout Task timeout */ | |
833 /* TCC_Terminate Task terminate */ | |
834 /* */ | |
835 /* CALLS */ | |
836 /* */ | |
837 /* CSC_Remove_From_List Remove suspend block from */ | |
838 /* the suspension list */ | |
839 /* */ | |
840 /* INPUTS */ | |
841 /* */ | |
842 /* information Pointer to suspend block */ | |
843 /* */ | |
844 /* OUTPUTS */ | |
845 /* */ | |
846 /* None */ | |
847 /* */ | |
848 /* HISTORY */ | |
849 /* */ | |
850 /* DATE REMARKS */ | |
851 /* */ | |
852 /* 03-01-1993 Created initial version 1.0 */ | |
853 /* 04-19-1993 Verified version 1.0 */ | |
854 /* */ | |
855 /*************************************************************************/ | |
856 VOID PMC_Cleanup(VOID *information) | |
857 { | |
858 | |
859 PM_SUSPEND *suspend_ptr; /* Suspension block pointer */ | |
860 NU_SUPERV_USER_VARIABLES | |
861 | |
862 /* Switch to supervisor mode */ | |
863 NU_SUPERVISOR_MODE(); | |
864 | |
865 /* Use the information pointer as a suspend pointer. */ | |
866 suspend_ptr = (PM_SUSPEND *) information; | |
867 | |
868 /* By default, indicate that the service timed-out. It really does not | |
869 matter if this function is called from a terminate request since | |
870 the task does not resume. */ | |
871 suspend_ptr -> pm_return_status = NU_TIMEOUT; | |
872 suspend_ptr -> pm_return_pointer = NU_NULL; | |
873 | |
874 /* Decrement the number of tasks waiting counter. */ | |
875 (suspend_ptr -> pm_partition_pool) -> pm_tasks_waiting--; | |
876 | |
877 /* Unlink the suspend block from the suspension list. */ | |
878 CSC_Remove_From_List((CS_NODE **) | |
879 &((suspend_ptr -> pm_partition_pool) -> pm_suspension_list), | |
880 &(suspend_ptr -> pm_suspend_link)); | |
881 | |
882 /* Return to user mode */ | |
883 NU_USER_MODE(); | |
884 } | |
885 | |
886 | |
887 | |
888 | |
889 |