嵌入式操作系统内核原理和开发（多线程轮转）

void task_init(int index, UINT32 data[], int size, void (*func)())51Testing软件测试网\`.t*j)U'wP
{
Fl LCB'|0        UINT32 unit = size;

        memset((void*)data, 0, size * sizeof(UINT32));
'O"p#b!C2J7sX&A1?7Lk$@0        data[unit -1] = (UINT32) func;
"Oq,BY`0        data[unit -2] = 0;51Testing软件测试网:Uoq8tO
        data[unit -3] = 0;51Testing软件测试网i4`[3Z[-P4^t
x:Y
        data[unit -4] = 0;
Wt,b
d m-B0        data[unit -5] = 0;51Testing软件测试网+NT^4M'C1R+S$A
        data[unit -6] = 0;51Testing软件测试网4}z9qr k&Cr$b?
        data[unit -7] = 0;51Testing软件测试网*q[
pv&l"p8I
        data[unit -8] = 0;51Testing软件测试网]1~e"^'sD8n
        data[unit -9] = 0;51Testing软件测试网wI;z R&wkXQ'Lx
        data[unit -10] = (UINT32) &data[unit - 9];
\goh9I7E0        new[index] = (UINT32) &data[unit -10];
g)j
Sa,CZf!x5?0}

void set_all_task()51Testing软件测试网%yQ_C]*_V
{
(@'W-~(g~%Pr"E0        int index;51Testing软件测试网6eYu8p
b8m

        for(index = 0; index < THREAD_MAX_NUMBER; index ++)51Testing软件测试网#bmT2a?\/H5g1I
            task_init(index, task_stack[index], STACK_LENGTH, hello);
YK8Q;b-I'Z(V7e0}

void signal_handler(int m)51Testing软件测试网6f2m&v'e(o
{51Testing软件测试网%HH?cB+_)B
        current_thread_id = current_thread_id % THREAD_MAX_NUMBER;51Testing软件测试网3\3S3MG;W*a
B[

        if(0 == quit[current_thread_id])51Testing软件测试网z@+@,c(^hD?@
        {
mPURsu0            swap(&old, &new[current_thread_id]);
le'x]3E$`2r`0        }

        printf("count = %d in main!\n\n",  count ++);
2O2P#T
eHi'[t7S0_~?0        current_thread_id ++;
x+sq[!N%K"y%\0}

?0rG%_A3K0#include <stdio.h>
m.PI ]!I)BKe-t0#include <time.h>
;S/r3I$Vz0#include <stdlib.h>
7J6I'}l0REO3|P0#include <signal.h>51Testing软件测试网 U"H"Ie(|x
#include <assert.h>
{}&\:l"v0#include <sys/time.h>

#define UINT32 unsigned   int51Testing软件测试网 VKQv1M
#define STACK_LENGTH      512
ncmXu1W3\0#define THREAD_MAX_NUMBER 1051Testing软件测试网-o%~1DW? ^,o

1mux
G+G'nc0struct itimerval oldtv;
$Bxdv/h}U0UINT32 old   = 0;
m1jl@@#w-ta0UINT32 count = 0;51Testing软件测试网V;H'y0\HQ
UINT32 task_stack[THREAD_MAX_NUMBER][STACK_LENGTH] = {0};
S d Y7LGF0UINT32 new[THREAD_MAX_NUMBER]  = {0};
,|?-d-l3n!U0UINT32 quit[THREAD_MAX_NUMBER] = {0};
HfHn0g iPz0UINT32 current_thread_id = 0;51Testing软件测试网C X?lr%O&c4ZQ |P

void set_timer()
z_(~.E'e"h%p0{51Testing软件测试网^JCHUH&V/NU
        struct itimerval itv;51Testing软件测试网u^Bg0UY
        itv.it_interval.tv_sec = 1;
0w?t`,mg0        itv.it_interval.tv_usec = 0;
Xwd5bN0        itv.it_value.tv_sec = 1;
!d,bt9E l4[V\0        itv.it_value.tv_usec = 0;51Testing软件测试网"Up\`/rt2yKiY8k
        setitimer(ITIMER_REAL, &itv, &oldtv);
\ xC"]3~v-Q$Y0}51Testing软件测试网/D*HMY1~5w+cS

void swap(UINT32* prev, UINT32* next)51Testing软件测试网H`3z.Px3]0d
{
8z h GidT6E*d6_dH0    __asm("push %%eax\n\t"
zcxi+Z0          "push %%ebx\n\t"
WG-[ L ~||&~0          "push %%ecx\n\t"51Testing软件测试网 o;y*o?&o{
          "push %%edx\n\t"
9@i [4}C
Pn1]({L0          "push %%esi\n\t"
U*fa T)Cr$R0          "push %%edi\n\t"51Testing软件测试网3t U MO+zY
          "push %%ebp\n\t"51Testing软件测试网'`g!]5sIp
          "push %%esp\n\t"51Testing软件测试网*Y!I6r3C4a(u
          "lea 0x8(%%ebp), %%eax\n\t"51Testing软件测试网 m+|3FuNt6Yb9z(k
          "mov (%%eax), %%eax\n\t"
/~"Knk1Oi0          "mov %%esp, (%%eax)\n\t"51Testing软件测试网5[\ mM0? f;W8[

          "lea 0xc(%%ebp), %%eax\n\t"
Gu0K&_&N4b0          "mov (%%eax), %%eax\n\t"
6jf)o%b qm0          "mov (%%eax), %%esp\n\t"
3~YI z'kfx0          "pop %%esp\n\t"
^/q ZId.D/GW'MA0          "pop %%ebp\n\t"
~p@n8j0?%Y0          "pop %%edi\n\t"51Testing软件测试网k4Y1vz@\F
          "pop %%esi\n\t"51Testing软件测试网ruO
C^i!g
          "pop %%edx\n\t"51Testing软件测试网;TI
F1qnlk*Y$L/y
          "pop %%ecx\n\t"
a2nA PS+i;oX%e1D2^"R0          "pop %%ebx\n\t"
;KGTLAMxV%^0          "pop %%eax\n\t"
|5A4Z(ui3H5A2@0Q8T0          ::);
)q3@qS6s xG8n0}

void hello()
!X:s*p%u*Oh(Pse0{
,WP/@ {2z-k8e9[0     while(1) {
!h7g B7^'P \;`T0            printf("id = %i, count = %d in thread!\n",current_thread_id,  count ++);51Testing软件测试网~0Zn3w%B4Nn:]K
            swap(&new[current_thread_id], &old);51Testing软件测试网$bgIu"R6[-d$S:{

            printf("id = %i, count = %d in thread!\n",current_thread_id,  count ++);
Gn!o;Np.YtzjM^0            swap(&new[current_thread_id], &old);
B3o]V8g$M&aQ0        }51Testing软件测试网IK s4e.y wP
}51Testing软件测试网+b&]ZE R*A+v+l

\G'u@2R[0void task_init(int index, UINT32 data[], int size, void (*func)())51Testing软件测试网P
mF^7QH
{51Testing软件测试网-[ Q'W)u%t8a(k
        UINT32 unit = size;

        memset((void*)data, 0, size * sizeof(UINT32));
y#C*^%b
?Y@0        data[unit -1] = (UINT32) func;
'{N R(W$I4tF0@.t ~0        data[unit -2] = 0;
g,m,ZY ANT0        data[unit -3] = 0;51Testing软件测试网 C-N1`bt2{RH3K-i
        data[unit -4] = 0;
/Au&U&n
MC0        data[unit -5] = 0;
BdC$Qf[2x:njf0        data[unit -6] = 0;51Testing软件测试网C(bF @ZV*WW6Zi
        data[unit -7] = 0;
'G*C[2f @;RH0        data[unit -8] = 0;51Testing软件测试网.Z&?$tD8l||
        data[unit -9] = 0;
`?zk6u.sv+d0        data[unit -10] = (UINT32) &data[unit - 9];51Testing软件测试网6Q4x.lZj-L:Xm
        new[index] = (UINT32) &data[unit -10];51Testing软件测试网K \wE"[xN3pU
}51Testing软件测试网Dv9@3~uMO_&H0[u

2R#N`PN/q5nzh8G#d v0void signal_handler(int m)51Testing软件测试网rD~,L^1F C9m
{
+c(m `(B
~(M7QAV2?0        current_thread_id = current_thread_id % THREAD_MAX_NUMBER;51Testing软件测试网WR5m}F(N6w

iP]J9so0        if(0 == quit[current_thread_id])
+M3B2H7Ml]H0TZ0        {51Testing软件测试网:OyF#TX
            swap(&old, &new[current_thread_id]);
IR7@%VN*G:D r0        }

        printf("count = %d in main!\n\n",  count ++);
T2p Q8i`5V{
nR0        current_thread_id ++;
3^cc.o3C |c0}

void set_all_task()
?n\d)J zte0{
~B0V*A-e
mLI0        int index;51Testing软件测试网H%KA:V:w4a0{

hk)e;t(EK:Dt0        for(index = 0; index < THREAD_MAX_NUMBER; index ++)51Testing软件测试网C2Wz.N!kx L1Y v
            task_init(index, task_stack[index], STACK_LENGTH, hello);51Testing软件测试网qf)oD7n
}

int main()
2X|}{Cxl0{
7ljZ(Y
@/{|'J;F0        char val;51Testing软件测试网6J;R5h5_:r(u"u:s

UmK+t9pJic v)o0        set_all_task();
g6w}*w!A0        set_timer();51Testing软件测试网_u.J4Pi
        signal(SIGALRM, signal_handler);

        while(1)

@\H5r3{0        {51Testing软件测试网(R'bo:i
X#jG-]
            scanf("%c", &val);51Testing软件测试网"Je#^1q1F
{
n}F
        }

        exit(0);51Testing软件测试网F-e2k!A8I#GS9@
        return 1;
+Tl;Ki0g7R0}