Category

Development Platform
Home > SourceCode/Document > OS Develop > View Code
CPUJMP.C
Package: ertos.rar　[view]
Upload User: sunrenlu
Upload Date: 2022-06-13
Package Size: 1419k
Code Size: 3k
Category:

OS Develop

Development Platform:

DOS

CPUJMP.C：Code Content
  1. /*
  2.  * CPU specific code for Intel compatible chips
  3.  */
  5. #pragma inline
  6. #include <asmrules.h>
  7. #include <cpujmp.h>
  10. int cpusetjmp(cpu_jmp_buf jmpb)
  11. {
  12.     /* save flags in bx */
  13.     asm     pushf
  14.     asm     pop     bx
  16.     /* save es,di */
  17.     asm     mov     dx, es
  18.     asm     mov     cx, di
  20.     /* reference the block */
  21.     asm     les     di, jmpb
  22.     asm     cld
  24.     /* save sp, ss */
  25.     asm     lea     ax, jmpb
  26.     asm     stosw
  27.     asm     mov     ax, SS
  28.     asm     stosw
  30.     /* remember, we saved the flags in bx, save to struct now */
  31.     asm     xchg    ax,bx
  32.     asm     stosw
  34.     /* get CS and IP from caller stack, save 'em */
  35.     asm     mov     ax, W1(jmpb-cPtrSize)   /* large code */
  36.     asm     stosw
  37.     asm     mov     ax, W0(jmpb-cPtrSize)
  38.     asm     stosw
  41.     /* save BP, DI, ES, SI */
  42.     asm     mov     ax, [bp]
  43.     asm     stosw                   /* BP */
  44.     asm     xchg    ax, cx
  45.     asm     stosw                   /* DI */
  46.     asm     mov     ax, dx
  47.     asm     stosw                   /* ES */
  48.     asm     xchg    ax, si
  49.     asm     stosw                   /* SI */
  51.     asm     mov     ax, ds
  53.     asm     stosw                   /* DS */
  54.     asm     mov     es, dx          /* restore ES */
  55.     return 0;
  56. }
  58. void cpulongjmp(cpu_jmp_buf jmpb, int retval)
  59. {
  60.     /* if (retval==0) retval=1; */
  61.     asm     mov     dx, retval
  62.     asm     cmp     dx, 1           /* generates carry if dx=0      */
  63.     asm     adc     dx, 0           /* if was 0, now it's 1  */
  65.     asm     LDS_    si, jmpb
  66.     asm     cld
  68.     /* Change context begins with changing stack */
  70.     asm     pushf                   /* save state of interrupt flag */
  71.     asm     pop     bx              /*  in bx */
  72.     asm     lodsw                   /* sp */
  73.     asm     cli
  74.     asm     mov     ss, [si]        /* SS */
  75.     asm     mov     sp, ax
  76.     asm     push    bx              /* restore state of interrupt flag */
  77.     asm     popf
  78.     asm     lodsw                   /* skip SS */
  80.     asm     lodsw                   /* flags */
  82.         /* need to build link to setjmp's caller IP:CS:FLAGS */
  83.     asm     push    ax              /* flags */
  84.     asm     lodsw                   /* cs */
  85.     asm     push    ax
  86.     asm     lodsw                   /* ip */
  87.     asm     push    ax
  89.         /* restore remaining working registers */
  90.     asm     lodsw                   /* bp */
  91.     asm     xchg    bp, ax
  92.     asm     lodsw                   /* di */
  93.     asm     xchg    di, ax
  94.     asm     lodsw                   /* es */
  95.     asm     mov     es, ax
  96.     asm     lodsw                   /* si */
  97.     asm     mov     ds, [si]
  98.     asm     xchg    si, ax
  100.     asm     xchg    ax, dx          /* restore AX  */
  101.     asm     iret                    /* return to original setjmp caller */
  102. }