cpu_c.c

Bycore是一个嵌入式操作系统内核。Bycore包括内存管理、任务管理、中断管理、任务互斥、同步与通信管理等功能。Bycore全部由C语言完成

/**
 *  cpu_c.c - init_stack is only implemented.
 *
 *  Copyright (C) 2008  ZhangHu
 *  All rights reserved.
 *  E-MAIL: [e-mail]
 *
 *  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 3 of the License, or
 *  (at your option) any later version.
 *
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with this program.  If not, see <http://www.gnu.org/licenses/>.
 */


#include "arch/arm7/cpu.h"
#include "include/core.h"
#include "regdef.h"

/**
 * init_stack - Initialize task stack.
 * @pstk: Pointer to peak of stack.
 * @reg_cnt: Number of Registes that needed to initialized.
 * @return: Peak of stack.
 *
 * @notes: PC has been initialized, and it was set in the bottom of stask.
 */
void init_context(word_t *space) {
    word_t *p = space;
    word_t i = 0;
    word_t reg_cnt = 17;
    word_t value[17] = {
        0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0x1F, 0x1F
    };

#if STACK == UP  /* Up Growth */
    for(i = 0; i < reg_cnt; i++) {
        *p++ = value[i];
    }
    p--;
    space[2] = (word_t)p; // space[2] is SP.

#else   /* Down Growth */
    for(i = 0; i < reg_cnt; i++) {
        *p-- = value[i];
    }
    p++;
    p[15] = (word_t)p;  // P[15] is SP.
#endif
}