*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
+ * the Free Software Foundation; version 2 of the License.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
/* Push ACC first, as when restoring the context it must be restored
* last (it is used to set the IE register). */
push ACC
- /* Store the IE register then disable interrupts. */
+ /* Store the IE register then enable interrupts. */
push _IEN0
- clr _EA
+ setb _EA
push DPL
push DPH
push b
if (ao_cur_task_id != AO_NO_TASK)
{
/* Save the current stack */
- stack_len = SP - AO_STACK_START;
+ stack_len = SP - (AO_STACK_START - 1);
ao_cur_task->stack_count = stack_len;
stack_ptr = (uint8_t __data *) AO_STACK_START;
save_ptr = (uint8_t __xdata *) ao_cur_task->stack;
}
/* Empty the stack; might as well let interrupts have the whole thing */
- SP = AO_STACK_START;
+ SP = AO_STACK_START - 1;
/* Find a task to run. If there isn't any runnable task,
* this loop will run forever, which is just fine
/* Restore the old stack */
stack_len = ao_cur_task->stack_count;
+ SP = AO_STACK_START - 1 + stack_len;
+
stack_ptr = (uint8_t __data *) AO_STACK_START;
save_ptr = (uint8_t __xdata *) ao_cur_task->stack;
while (stack_len--)
*stack_ptr++ = *save_ptr++;
- SP = (uint8_t) (stack_ptr - 1);
_asm
pop _bp