FreeCalypso > hg > ffs-editor
comparison src/nucleus/ioc.c @ 0:92470e5d0b9e
src: partial import from FC Selenite
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Fri, 15 May 2020 01:28:16 +0000 |
parents | |
children |
comparison
equal
deleted
inserted
replaced
-1:000000000000 | 0:92470e5d0b9e |
---|---|
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 /* ioc.c Nucleus PLUS 1.14 */ | |
17 /* */ | |
18 /* COMPONENT */ | |
19 /* */ | |
20 /* IO - Input/Output Driver Management */ | |
21 /* */ | |
22 /* DESCRIPTION */ | |
23 /* */ | |
24 /* This file contains the core routines for the I/O Driver */ | |
25 /* Management component. */ | |
26 /* */ | |
27 /* DATA STRUCTURES */ | |
28 /* */ | |
29 /* None */ | |
30 /* */ | |
31 /* FUNCTIONS */ | |
32 /* */ | |
33 /* IOC_Create_Driver Create an I/O driver */ | |
34 /* IOC_Delete_Driver Delete an I/O driver */ | |
35 /* IOC_Request_Driver Make an I/O driver request */ | |
36 /* IOC_Resume_Driver Resume a task suspended in */ | |
37 /* an I/O driver */ | |
38 /* IOC_Suspend_Driver Suspend a task inside an I/O */ | |
39 /* driver */ | |
40 /* */ | |
41 /* DEPENDENCIES */ | |
42 /* */ | |
43 /* cs_extr.h Common Service functions */ | |
44 /* tc_extr.h Thread Control functions */ | |
45 /* io_extr.h I/O driver functions */ | |
46 /* hi_extr.h History functions */ | |
47 /* */ | |
48 /* HISTORY */ | |
49 /* */ | |
50 /* DATE REMARKS */ | |
51 /* */ | |
52 /* 03-01-1993 Created initial version 1.0 */ | |
53 /* 04-19-1993 Verified version 1.0 */ | |
54 /* 08-09-1993 Corrected pointer retrieval */ | |
55 /* loop, resulting in version 1.0a */ | |
56 /* 08-09-1993 Verified version 1.0a */ | |
57 /* 03-01-1994 Moved non-core functions into */ | |
58 /* supplemental files, changed */ | |
59 /* function interfaces to match */ | |
60 /* those in prototype, changed */ | |
61 /* protection logic to reduce */ | |
62 /* overhead, resulting in */ | |
63 /* version 1.1 */ | |
64 /* */ | |
65 /* 03-15-1994 Verified version 1.1 */ | |
66 /* 04-17-1996 updated to version 1.2 */ | |
67 /* 04-23-1996 Corrected SPR121. */ | |
68 /* 03-24-1998 Released version 1.3 */ | |
69 /* 03-26-1999 Released 1.11m (new release */ | |
70 /* numbering scheme) */ | |
71 /* 04-07-1999 Release 1.11mA */ | |
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 "io_extr.h" /* I/O driver functions */ | |
81 #include "hi_extr.h" /* History functions */ | |
82 #include "profiler.h" /* ProView interface */ | |
83 | |
84 /* Define external inner-component global data references. */ | |
85 | |
86 extern CS_NODE *IOD_Created_Drivers_List; | |
87 extern UNSIGNED IOD_Total_Drivers; | |
88 extern TC_PROTECT IOD_List_Protect; | |
89 | |
90 | |
91 | |
92 /*************************************************************************/ | |
93 /* */ | |
94 /* FUNCTION */ | |
95 /* */ | |
96 /* IOC_Create_Driver */ | |
97 /* */ | |
98 /* DESCRIPTION */ | |
99 /* */ | |
100 /* This function creates an I/O driver and places it on the list of */ | |
101 /* created I/O drivers. Note that this function does not actually */ | |
102 /* invoke the driver. */ | |
103 /* */ | |
104 /* CALLED BY */ | |
105 /* */ | |
106 /* Application */ | |
107 /* IOCE_Create_Driver Error checking shell */ | |
108 /* */ | |
109 /* CALLS */ | |
110 /* */ | |
111 /* CSC_Place_On_List Add node to linked-list */ | |
112 /* [HIC_Make_History_Entry] Make entry in history log */ | |
113 /* [TCT_Check_Stack] Stack checking function */ | |
114 /* TCT_Protect Data structure protect */ | |
115 /* TCT_Unprotect Un-protect data structure */ | |
116 /* */ | |
117 /* INPUTS */ | |
118 /* */ | |
119 /* driver Driver control block pointer */ | |
120 /* name Driver's logical name */ | |
121 /* driver_entry Driver's point of entry */ | |
122 /* */ | |
123 /* OUTPUTS */ | |
124 /* */ | |
125 /* NU_SUCCESS */ | |
126 /* */ | |
127 /* HISTORY */ | |
128 /* */ | |
129 /* DATE REMARKS */ | |
130 /* */ | |
131 /* 03-01-1993 Created initial version 1.0 */ | |
132 /* 04-19-1993 Verified version 1.0 */ | |
133 /* */ | |
134 /*************************************************************************/ | |
135 STATUS IOC_Create_Driver(NU_DRIVER *driver, CHAR *name, | |
136 VOID (*driver_entry)(NU_DRIVER *, NU_DRIVER_REQUEST *)) | |
137 { | |
138 | |
139 INT i; /* Working index variable */ | |
140 NU_SUPERV_USER_VARIABLES | |
141 | |
142 /* Switch to supervisor mode */ | |
143 NU_SUPERVISOR_MODE(); | |
144 | |
145 #ifdef NU_ENABLE_STACK_CHECK | |
146 | |
147 /* Call stack checking function to check for an overflow condition. */ | |
148 TCT_Check_Stack(); | |
149 | |
150 #endif | |
151 | |
152 #ifdef NU_ENABLE_HISTORY | |
153 | |
154 /* Make an entry that corresponds to this function in the system history | |
155 log. */ | |
156 HIC_Make_History_Entry(NU_CREATE_DRIVER_ID, (UNSIGNED) driver, | |
157 (UNSIGNED) name, (UNSIGNED) driver_entry); | |
158 | |
159 #endif | |
160 | |
161 /* First, clear the driver ID just in case it is an old Driver | |
162 Control Block. */ | |
163 driver -> nu_driver_id = 0; | |
164 | |
165 /* Fill in the driver's name. */ | |
166 for (i = 0; i < NU_MAX_NAME; i++) | |
167 driver -> nu_driver_name[i] = name[i]; | |
168 | |
169 /* Save the driver's entry function in the control block. */ | |
170 driver -> nu_driver_entry = driver_entry; | |
171 | |
172 /* Protect against access to the list of created drivers. */ | |
173 TCT_Protect(&IOD_List_Protect); | |
174 | |
175 /* At this point the driver is completely built. The ID can now be | |
176 set and it can be linked into the created driver list. */ | |
177 driver -> nu_driver_id = IO_DRIVER_ID; | |
178 | |
179 /* Link the driver into the list of created I/O drivers and increment the | |
180 total number of drivers in the system. */ | |
181 CSC_Place_On_List(&IOD_Created_Drivers_List, (CS_NODE *) driver); | |
182 IOD_Total_Drivers++; | |
183 | |
184 #ifdef INCLUDE_PROVIEW | |
185 _RTProf_DumpDriver(RT_PROF_CREATE_DRIVER, driver, RT_PROF_OK); | |
186 #endif /*INCLUDE_PROVIEW*/ | |
187 /* Release protection against access to the list of created I/O drivers. */ | |
188 TCT_Unprotect(); | |
189 | |
190 /* Return to user mode */ | |
191 NU_USER_MODE(); | |
192 | |
193 /* Return successful completion. */ | |
194 return(NU_SUCCESS); | |
195 } | |
196 | |
197 | |
198 /*************************************************************************/ | |
199 /* */ | |
200 /* FUNCTION */ | |
201 /* */ | |
202 /* IOC_Delete_Driver */ | |
203 /* */ | |
204 /* DESCRIPTION */ | |
205 /* */ | |
206 /* This function deletes an I/O driver and removes it from the list */ | |
207 /* of created drivers. Note that this function does not actually */ | |
208 /* invoke the driver. */ | |
209 /* */ | |
210 /* CALLED BY */ | |
211 /* */ | |
212 /* Application */ | |
213 /* IOCE_Delete_Driver Error checking shell */ | |
214 /* */ | |
215 /* CALLS */ | |
216 /* */ | |
217 /* CSC_Remove_From_List Remove node from list */ | |
218 /* [HIC_Make_History_Entry] Make entry in history log */ | |
219 /* [TCT_Check_Stack] Stack checking function */ | |
220 /* TCT_Protect Protect created list */ | |
221 /* TCT_Unprotect Release protection */ | |
222 /* */ | |
223 /* INPUTS */ | |
224 /* */ | |
225 /* driver Driver control block pointer */ | |
226 /* */ | |
227 /* OUTPUTS */ | |
228 /* */ | |
229 /* NU_SUCCESS */ | |
230 /* */ | |
231 /* HISTORY */ | |
232 /* */ | |
233 /* DATE REMARKS */ | |
234 /* */ | |
235 /* 03-01-1993 Created initial version 1.0 */ | |
236 /* 04-19-1993 Verified version 1.0 */ | |
237 /* */ | |
238 /*************************************************************************/ | |
239 STATUS IOC_Delete_Driver(NU_DRIVER *driver) | |
240 { | |
241 NU_SUPERV_USER_VARIABLES | |
242 | |
243 /* Switch to supervisor mode */ | |
244 NU_SUPERVISOR_MODE(); | |
245 | |
246 #ifdef NU_ENABLE_STACK_CHECK | |
247 | |
248 /* Call stack checking function to check for an overflow condition. */ | |
249 TCT_Check_Stack(); | |
250 | |
251 #endif | |
252 | |
253 #ifdef NU_ENABLE_HISTORY | |
254 | |
255 /* Make an entry that corresponds to this function in the system history | |
256 log. */ | |
257 HIC_Make_History_Entry(NU_DELETE_DRIVER_ID, (UNSIGNED) driver , | |
258 (UNSIGNED) 0, (UNSIGNED) 0); | |
259 | |
260 #endif | |
261 | |
262 /* Protect against access to the list of created I/O drivers. */ | |
263 TCT_Protect(&IOD_List_Protect); | |
264 | |
265 #ifdef INCLUDE_PROVIEW | |
266 _RTProf_DumpDriver(RT_PROF_DELETE_DRIVER, driver, RT_PROF_OK); | |
267 #endif /*INCLUDE_PROVIEW*/ | |
268 /* Set the driver ID to 0. */ | |
269 driver -> nu_driver_id = 0; | |
270 | |
271 /* Remove the driver from the list of created I/O drivers. */ | |
272 CSC_Remove_From_List(&IOD_Created_Drivers_List, (CS_NODE *) driver); | |
273 | |
274 /* Decrement the total number of created I/O drivers. */ | |
275 IOD_Total_Drivers--; | |
276 | |
277 /* Release protection against access to the list of created I/O drivers. */ | |
278 TCT_Unprotect(); | |
279 | |
280 /* Return to user mode */ | |
281 NU_USER_MODE(); | |
282 | |
283 /* Return a successful completion. */ | |
284 return(NU_SUCCESS); | |
285 } | |
286 | |
287 | |
288 /*************************************************************************/ | |
289 /* */ | |
290 /* FUNCTION */ | |
291 /* */ | |
292 /* IOC_Request_Driver */ | |
293 /* */ | |
294 /* DESCRIPTION */ | |
295 /* */ | |
296 /* This function sends a user request to the specified I/O driver. */ | |
297 /* */ | |
298 /* CALLED BY */ | |
299 /* */ | |
300 /* Application */ | |
301 /* IOCE_Request_Driver Error checking shell */ | |
302 /* */ | |
303 /* CALLS */ | |
304 /* */ | |
305 /* [HIC_Make_History_Entry] Make entry in history log */ | |
306 /* [TCT_Check_Stack] Stack checking function */ | |
307 /* */ | |
308 /* INPUTS */ | |
309 /* */ | |
310 /* driver Driver control block pointer */ | |
311 /* request User's I/O request */ | |
312 /* */ | |
313 /* OUTPUTS */ | |
314 /* */ | |
315 /* NU_SUCCESS If service is successful */ | |
316 /* */ | |
317 /* HISTORY */ | |
318 /* */ | |
319 /* DATE REMARKS */ | |
320 /* */ | |
321 /* 03-01-1993 Created initial version 1.0 */ | |
322 /* 04-19-1993 Verified version 1.0 */ | |
323 /* */ | |
324 /*************************************************************************/ | |
325 STATUS IOC_Request_Driver(NU_DRIVER *driver , NU_DRIVER_REQUEST *request) | |
326 { | |
327 NU_SUPERV_USER_VARIABLES | |
328 | |
329 /* Switch to supervisor mode */ | |
330 NU_SUPERVISOR_MODE(); | |
331 | |
332 #ifdef NU_ENABLE_STACK_CHECK | |
333 | |
334 /* Call stack checking function to check for an overflow condition. */ | |
335 TCT_Check_Stack(); | |
336 | |
337 #endif | |
338 | |
339 #ifdef NU_ENABLE_HISTORY | |
340 | |
341 /* Make an entry that corresponds to this function in the system history | |
342 log. */ | |
343 HIC_Make_History_Entry(NU_REQUEST_DRIVER_ID, (UNSIGNED) driver, | |
344 (UNSIGNED) request, (UNSIGNED) 0); | |
345 | |
346 #endif | |
347 | |
348 #ifdef INCLUDE_PROVIEW | |
349 _RTProf_DumpDriver(RT_PROF_REQUEST_DRIVER, driver, RT_PROF_OK); | |
350 #endif /*INCLUDE_PROVIEW*/ | |
351 /* Call the specified I/O Driver. */ | |
352 (*(driver -> nu_driver_entry)) (driver, request); | |
353 | |
354 /* Return to user mode */ | |
355 NU_USER_MODE(); | |
356 | |
357 /* Return the completion status. */ | |
358 return(NU_SUCCESS); | |
359 } | |
360 | |
361 | |
362 /*************************************************************************/ | |
363 /* */ | |
364 /* FUNCTION */ | |
365 /* */ | |
366 /* IOC_Resume_Driver */ | |
367 /* */ | |
368 /* DESCRIPTION */ | |
369 /* */ | |
370 /* This function resumes a task previously suspended inside of an */ | |
371 /* I/O driver. Typically, this function is called from within an */ | |
372 /* I/O driver. */ | |
373 /* */ | |
374 /* CALLED BY */ | |
375 /* */ | |
376 /* Application */ | |
377 /* IOCE_Resume_Driver Error checking shell */ | |
378 /* */ | |
379 /* CALLS */ | |
380 /* */ | |
381 /* [HIC_Make_History_Entry] Make entry in history log */ | |
382 /* TCC_Resume_Task Resume a suspended task */ | |
383 /* TCT_Control_To_System Transfer control to higher */ | |
384 /* priority task */ | |
385 /* [TCT_Check_Stack] Stack checking function */ | |
386 /* TCT_Get_Current_Protect Pickup current protection */ | |
387 /* TCT_Set_Current_Protect Set current protection */ | |
388 /* TCT_System_Protect Protect against system access*/ | |
389 /* TCT_System_Unprotect Release system protection */ | |
390 /* TCT_Unprotect Release system protection */ | |
391 /* TCT_Unprotect_Specific Release specific protection */ | |
392 /* */ | |
393 /* INPUTS */ | |
394 /* */ | |
395 /* task Pointer of task to resume */ | |
396 /* */ | |
397 /* OUTPUTS */ | |
398 /* */ | |
399 /* NU_SUCCESS If service is successful */ | |
400 /* */ | |
401 /* HISTORY */ | |
402 /* */ | |
403 /* DATE REMARKS */ | |
404 /* */ | |
405 /* 03-01-1993 Created initial version 1.0 */ | |
406 /* 04-19-1993 Verified version 1.0 */ | |
407 /* 03-01-1994 Changed function interfaces to */ | |
408 /* match prototype, changed */ | |
409 /* protection logic, resulting in */ | |
410 /* version 1.1 */ | |
411 /* */ | |
412 /* 03-18-1994 Verified version 1.1 */ | |
413 /* 04-23-1996 Corrected SPR121 */ | |
414 /* */ | |
415 /*************************************************************************/ | |
416 STATUS IOC_Resume_Driver(NU_TASK *task) | |
417 { | |
418 | |
419 TC_PROTECT *save_protect; /* Saved protect pointer */ | |
420 NU_SUPERV_USER_VARIABLES | |
421 | |
422 | |
423 /* Switch to supervisor mode */ | |
424 NU_SUPERVISOR_MODE(); | |
425 | |
426 #ifdef NU_ENABLE_STACK_CHECK | |
427 | |
428 /* Call stack checking function to check for an overflow condition. */ | |
429 TCT_Check_Stack(); | |
430 | |
431 #endif | |
432 | |
433 #ifdef NU_ENABLE_HISTORY | |
434 | |
435 /* Make an entry that corresponds to this function in the system history | |
436 log. */ | |
437 HIC_Make_History_Entry(NU_RESUME_DRIVER_ID, (UNSIGNED) task, | |
438 (UNSIGNED) 0, (UNSIGNED) 0); | |
439 | |
440 #endif | |
441 | |
442 /* Pickup current protection. */ | |
443 save_protect = TCT_Get_Current_Protect(); | |
444 | |
445 /* Protect against system access. */ | |
446 TCT_System_Protect(); | |
447 | |
448 #ifdef INCLUDE_PROVIEW | |
449 _RTProf_DumpDriver(RT_PROF_RESUME_DRIVER, 0 , RT_PROF_OK); | |
450 #endif /*INCLUDE_PROVIEW*/ | |
451 /* Resume the specified task. */ | |
452 if (TCC_Resume_Task(task, NU_DRIVER_SUSPEND)) | |
453 { | |
454 /* Only unprotect if there is protection in place. */ | |
455 if (save_protect) | |
456 { | |
457 /* Release protection caller had. */ | |
458 TCT_Unprotect_Specific(save_protect); | |
459 } | |
460 | |
461 /* Transfer control to the system if the resumed task function | |
462 detects a preemption condition. */ | |
463 TCT_Control_To_System(); | |
464 } | |
465 else | |
466 { | |
467 | |
468 /* Determine if there was protection previously in force. */ | |
469 if (save_protect) | |
470 { | |
471 | |
472 /* Switch to original protection. */ | |
473 TCT_Set_Current_Protect(save_protect); | |
474 | |
475 /* Release system protection. */ | |
476 TCT_System_Unprotect(); | |
477 } | |
478 else | |
479 | |
480 /* Release system protection. */ | |
481 TCT_Unprotect(); | |
482 } | |
483 | |
484 /* Return to user mode */ | |
485 NU_USER_MODE(); | |
486 | |
487 /* Return the completion status. */ | |
488 return(NU_SUCCESS); | |
489 } | |
490 | |
491 | |
492 | |
493 /*************************************************************************/ | |
494 /* */ | |
495 /* FUNCTION */ | |
496 /* */ | |
497 /* IOC_Suspend_Driver */ | |
498 /* */ | |
499 /* DESCRIPTION */ | |
500 /* */ | |
501 /* This function suspends a task inside of an I/O driver. It is */ | |
502 /* the responsibility of the I/O driver to keep track of tasks */ | |
503 /* waiting inside of an I/O driver. */ | |
504 /* */ | |
505 /* CALLED BY */ | |
506 /* */ | |
507 /* Application */ | |
508 /* IOCE_Suspend_Driver Error checking shell */ | |
509 /* */ | |
510 /* CALLS */ | |
511 /* */ | |
512 /* [HIC_Make_History_Entry] Make entry in history log */ | |
513 /* TCC_Suspend_Task Suspend calling task */ | |
514 /* TCT_Current_Thread Current task thread */ | |
515 /* [TCT_Check_Stack] Stack checking function */ | |
516 /* TCT_Get_Current_Protect Pickup current protect ptr */ | |
517 /* TCT_Set_Suspend_Protect Setup suspend protect field */ | |
518 /* TCT_System_Protect Protect against system access*/ | |
519 /* TCT_Unprotect_Specific Release user protection */ | |
520 /* */ | |
521 /* INPUTS */ | |
522 /* */ | |
523 /* terminate_routine Termination/Timeout cleanup */ | |
524 /* routine */ | |
525 /* information Information pointer of the */ | |
526 /* cleanup routine */ | |
527 /* timeout Suspension timeout request */ | |
528 /* */ | |
529 /* OUTPUTS */ | |
530 /* */ | |
531 /* NU_SUCCESS If service is successful */ | |
532 /* */ | |
533 /* HISTORY */ | |
534 /* */ | |
535 /* DATE REMARKS */ | |
536 /* */ | |
537 /* 03-01-1993 Created initial version 1.0 */ | |
538 /* 04-19-1993 Verified version 1.0 */ | |
539 /* 03-01-1994 Changed protection logic, */ | |
540 /* resulting in version 1.1 */ | |
541 /* */ | |
542 /* 03-18-1994 Verified version 1.1 */ | |
543 /* 04-23-1996 Corrected SPR121. */ | |
544 /* */ | |
545 /*************************************************************************/ | |
546 STATUS IOC_Suspend_Driver(VOID (*terminate_routine)(VOID *), | |
547 VOID *information, UNSIGNED timeout) | |
548 { | |
549 | |
550 TC_PROTECT *suspend_protect; /* Current protection */ | |
551 NU_SUPERV_USER_VARIABLES | |
552 | |
553 /* Switch to supervisor mode */ | |
554 NU_SUPERVISOR_MODE(); | |
555 | |
556 #ifdef NU_ENABLE_STACK_CHECK | |
557 | |
558 /* Call stack checking function to check for an overflow condition. */ | |
559 TCT_Check_Stack(); | |
560 | |
561 #endif | |
562 | |
563 #ifdef NU_ENABLE_HISTORY | |
564 | |
565 /* Make an entry that corresponds to this function in the system history | |
566 log. */ | |
567 HIC_Make_History_Entry(NU_SUSPEND_DRIVER_ID, (UNSIGNED) terminate_routine, | |
568 (UNSIGNED) information, (UNSIGNED) timeout); | |
569 | |
570 #endif | |
571 | |
572 | |
573 /* Pickup current protect. */ | |
574 suspend_protect = TCT_Get_Current_Protect(); | |
575 | |
576 /* Setup system protection. */ | |
577 TCT_System_Protect(); | |
578 | |
579 #ifdef INCLUDE_PROVIEW | |
580 _RTProf_DumpDriver(RT_PROF_SUSPEND_DRIVER, 0 , RT_PROF_OK); | |
581 #endif /*INCLUDE_PROVIEW*/ | |
582 /* If no protection exists, don't unprotect. */ | |
583 if (suspend_protect) | |
584 { | |
585 /* Release initial protection. */ | |
586 TCT_Unprotect_Specific(suspend_protect); | |
587 | |
588 /* Save suspend protect for timeout and terminate. */ | |
589 TCT_Set_Suspend_Protect(suspend_protect); | |
590 } | |
591 | |
592 /* Suspend the calling task. */ | |
593 TCC_Suspend_Task((NU_TASK *) TCT_Current_Thread(), NU_DRIVER_SUSPEND, | |
594 terminate_routine, information, timeout); | |
595 | |
596 /* Return to user mode */ | |
597 NU_USER_MODE(); | |
598 | |
599 /* Return the completion status. */ | |
600 return(NU_SUCCESS); | |
601 } | |
602 | |
603 | |
604 | |
605 | |
606 |