#include <at89x52.h>

#define MAX_TASKS 2 // 最大任務數
#define MAX_TASK_DEP 12 // 每個任務的棧容量
unsigned char idata task_stack[MAX_TASKS][MAX_TASK_DEP]; // 任務棧
unsigned char idata task_sp[MAX_TASKS]; // 每個任務的運行位置
unsigned char task_id = 0; // 當前任務號

sbit LED = P1^4;
sbit LED2 = P1^5;

// 任務裝入函數
void task_load(unsigned int fn, unsigned char tid)
{
    task_sp[tid] = (unsigned char)&task_stack[tid][1];
    task_stack[tid][0] = fn & 0xff;
    task_stack[tid][1] = fn >> 8;
}

// 任務切換函數
void task_switch(void)
{
    task_sp[task_id] = SP;
    if (++task_id == MAX_TASKS)
        task_id = 0;
    SP = task_sp[task_id];
}

void delay(unsigned char n)
{
    char i;
    while (n--)
        for (i = 0; i < 115; i++);
}

void task1(void)
{
    while (1)
    {
        LED = 0;
        delay(500);
        LED = 1;
        delay(500);
       
        task_switch();
    }
}

void task2(void)
{
    while (1)
    {
        LED2 = 0;
        delay(500);
        LED2 = 1;
        delay(500);
       
        task_switch();
    }
}

int main(void)
{
    task_load(task1, 0);
    task_load(task2, 1);
    SP = task_sp[task_id];
    return 0;
}

注意：任務裝載函數中不能直接用unsigned int指針賦值，一次性訪問16個字節，否則[0]和[1]中的內容是反的，也就是[0]裡面裝的是高位(fn>>8)，[1]裡面裝的卻是低位(fn&0xff)，需要交換回來：
void task_load(unsigned int fn, unsigned char tid)
{
    unsigned char temp;
    task_sp[tid] = (unsigned char)&task_stack[tid][1];
    *(unsigned int *)task_stack[tid] = fn;
    temp = task_stack[tid][0];
    task_stack[tid][0] = task_stack[tid][1];
    task_stack[tid][1] = temp;
}

另外，main函數裡面的return 0也不能去掉或換成while(1)，否則單片機不會切換到SP所指向的函數地址。

本文參考資料：http://blog.csdn.net/wuhenyouyuyouyu/article/details/50883704