1 | /*
|
---|
2 | =============================================================================
|
---|
3 | mtstop.c -- Multi-Tasker -- stop task
|
---|
4 | Version 3 -- 1988-04-11 -- D.N. Lynx Crowe
|
---|
5 | (c) Copyright 1988 -- D.N. Lynx Crowe
|
---|
6 | =============================================================================
|
---|
7 | */
|
---|
8 |
|
---|
9 | #include "stddefs.h"
|
---|
10 | #include "biosdefs.h"
|
---|
11 | #include "mtdefs.h"
|
---|
12 |
|
---|
13 | extern short setipl(); /* set processor IPL function */
|
---|
14 |
|
---|
15 | extern struct _mt_def *_MT_;
|
---|
16 |
|
---|
17 | /* |
---|
18 |
|
---|
19 | */
|
---|
20 |
|
---|
21 | /*
|
---|
22 | =============================================================================
|
---|
23 | MTStop() -- stop a task
|
---|
24 |
|
---|
25 | -3 - task not stopped (was the current task)
|
---|
26 | -2 - task not stopped (can't find it on ready queue)
|
---|
27 | -1 - task not stopped (can't find it at all)
|
---|
28 |
|
---|
29 | 0 - task stopped (was ready to run)
|
---|
30 |
|
---|
31 | 1 - task stopped (was waiting)
|
---|
32 | 2 - task already stopped (wasn't waiting or on ready queue)
|
---|
33 | 3 - task will be stopped (has MTF_STP set)
|
---|
34 | =============================================================================
|
---|
35 | */
|
---|
36 |
|
---|
37 | short
|
---|
38 | MTStop(tid)
|
---|
39 | unsigned tid;
|
---|
40 | {
|
---|
41 | register short oldipl;
|
---|
42 | register TCB *tcbcur, *tcbprv;
|
---|
43 |
|
---|
44 | /* |
---|
45 |
|
---|
46 | */
|
---|
47 | if ((struct _mt_def *)NIL EQ _MT_)
|
---|
48 | _MT_ = (struct _mt_def *)XBIOS(X_MTDEFS);
|
---|
49 |
|
---|
50 | tcbcur = _MT_->mtp->TCBs; /* point at TCB table */
|
---|
51 |
|
---|
52 | oldipl = setipl(7); /* DISABLE INTERRUPTS */
|
---|
53 |
|
---|
54 | while (tcbcur) { /* check each TCB */
|
---|
55 |
|
---|
56 | if (tcbcur->flags & MTF_OCC) { /* TCB in use ? */
|
---|
57 |
|
---|
58 | if (tcbcur->tid EQ tid) { /* task we want ? */
|
---|
59 |
|
---|
60 | if (tcbcur->flags & MTF_STP) { /* stopped ? */
|
---|
61 |
|
---|
62 | setipl(oldipl); /* RESTORE INTERRUPTS */
|
---|
63 | return(3); /* task in stop state */
|
---|
64 | }
|
---|
65 |
|
---|
66 | if (tcbcur->flags & MTF_RUN) {
|
---|
67 |
|
---|
68 | setipl(oldipl); /* RESTORE INTERRUPTS */
|
---|
69 | return(-3); /* can't stop current task */
|
---|
70 | }
|
---|
71 |
|
---|
72 | if (tcbcur->flags & MTF_SWT) { /* waiting ? */
|
---|
73 |
|
---|
74 | tcbcur->flags |= MTF_STP; /* set to stop */
|
---|
75 |
|
---|
76 | setipl(oldipl); /* RESTORE INTERRUPTS */
|
---|
77 | return(1); /* task is waiting */
|
---|
78 | }
|
---|
79 |
|
---|
80 | if (NOT (tcbcur->flags & MTF_RDY)) { /* stopped ? */
|
---|
81 |
|
---|
82 | setipl(oldipl); /* RESTORE INTERRUPTS */
|
---|
83 | return(2); /* task was stopped */
|
---|
84 | }
|
---|
85 | /* |
---|
86 |
|
---|
87 | */
|
---|
88 | tcbprv = (TCB *)&_MT_->mtp->RdyQ;
|
---|
89 | tcbcur = tcbprv->next;
|
---|
90 |
|
---|
91 | while(tcbcur) { /* locate task on ready queue */
|
---|
92 |
|
---|
93 | tcbprv = tcbcur;
|
---|
94 | tcbcur = tcbprv->next;
|
---|
95 |
|
---|
96 | if (tcbcur NE (TCB *)NIL) {
|
---|
97 |
|
---|
98 | if (tcbcur->tid EQ tid) {
|
---|
99 |
|
---|
100 | tcbprv->next = tcbcur->next;
|
---|
101 | tcbcur->flags &= ~MTF_RDY;
|
---|
102 |
|
---|
103 | setipl(oldipl); /* RESTORE INTERRUPTS */
|
---|
104 | return(0); /* stopped a ready task */
|
---|
105 | }
|
---|
106 | }
|
---|
107 | }
|
---|
108 |
|
---|
109 | setipl(oldipl); /* RESTORE INTERRUPTS */
|
---|
110 | return(-2); /* can't find a ready task */
|
---|
111 | }
|
---|
112 | }
|
---|
113 |
|
---|
114 | tcbcur = tcbcur->fwd; /* point at next TCB */
|
---|
115 | }
|
---|
116 |
|
---|
117 | setipl(oldipl); /* RESTORE INTERRUPTS */
|
---|
118 | return(-1); /* can't find the task at all */
|
---|
119 | }
|
---|
120 |
|
---|