cpu_config.h

toppers操作系统源码

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2004 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 * 
 *  惧淡螟侯涪荚は·笆布の (1)×(4) の掘凤か·Free Software Foundation 
 *  によって给山されている GNU General Public License の Version 2 に淡
 *  揭されている掘凤を塔たす眷圭に嘎り·塑ソフトウェア∈塑ソフトウェア
 *  を猖恃したものを崔むˉ笆布票じ∷を蝗脱ˇ剩澜ˇ猖恃ˇ浩芹邵∈笆布·
 *  网脱と钙ぶ∷することを痰浸で钓满するˉ
 *  (1) 塑ソフトウェアをソ〖スコ〖ドの妨で网脱する眷圭には·惧淡の螟侯
 *      涪山绩·この网脱掘凤および布淡の痰瘦沮惮年が·そのままの妨でソ〖
 *      スコ〖ド面に崔まれていることˉ
 *  (2) 塑ソフトウェアを·ライブラリ妨及など·戮のソフトウェア倡券に蝗
 *      脱できる妨で浩芹邵する眷圭には·浩芹邵に燃うドキュメント∈网脱
 *      荚マニュアルなど∷に·惧淡の螟侯涪山绩·この网脱掘凤および布淡
 *      の痰瘦沮惮年を非很することˉ
 *  (3) 塑ソフトウェアを·怠达に寥み哈むなど·戮のソフトウェア倡券に蝗
 *      脱できない妨で浩芹邵する眷圭には·肌のいずれかの掘凤を塔たすこ
 *      とˉ
 *    (a) 浩芹邵に燃うドキュメント∈网脱荚マニュアルなど∷に·惧淡の螟
 *        侯涪山绩·この网脱掘凤および布淡の痰瘦沮惮年を非很することˉ
 *    (b) 浩芹邵の妨轮を·侍に年める数恕によって·TOPPERSプロジェクトに
 *        鼠桂することˉ
 *  (4) 塑ソフトウェアの网脱により木儡弄または粗儡弄に栏じるいかなる禄
 *      巢からも·惧淡螟侯涪荚およびTOPPERSプロジェクトを倘勒することˉ
 * 
 *  塑ソフトウェアは·痰瘦沮で捏丁されているものであるˉ惧淡螟侯涪荚お
 *  よびTOPPERSプロジェクトは·塑ソフトウェアに簇して·その努脱材墙拉も
 *  崔めて·いかなる瘦沮も乖わないˉまた·塑ソフトウェアの网脱により木
 *  儡弄または粗儡弄に栏じたいかなる禄巢に簇しても·その勒扦を砷わないˉ
 * 
 *  @(#) $Id: cpu_config.h,v 1.19 2004/09/17 13:45:55 honda Exp $
 */

/*
 *  プロセッサ巴赂モジュ〖ル∈ARM4vT脱∷
 *
 *  このインクル〖ドファイルは·t_config.h のみからインクル〖ドされるˉ
 *  戮のファイルから木儡インクル〖ドしてはならないˉ
 */

#ifndef _CPU_CONFIG_H_
#define _CPU_CONFIG_H_

/*
 *  カ〖ネル柒婶急侍叹のリネ〖ム
 */
#include "cpu_rename.h"

/*
 *  プロセッサの泼检炭吾のインライン簇眶年盗
 */
#ifndef _MACRO_ONLY
#include <cpu_insn.h>
#endif /* _MACRO_ONLY */

/*
 *  TCB 簇息の年盗
 *
 *  cpu_context.h に掐れる数がエレガントだが·徊救の巴赂拉の簇犯で·
 *  cpu_context.h には掐れられないˉ
 */

/*
 *  TCB 面のフィ〖ルドのビット升の年盗
 */
#define    TBIT_TCB_TSTAT       8    /* tstat フィ〖ルドのビット升 */
#define    TBIT_TCB_PRIORITY    8    /* priority フィ〖ルドのビット升 */

#ifndef _MACRO_ONLY
/*
 *  タスクコンテキストブロックの年盗
 */
typedef struct task_context_block {
    VP    sp;        /* スタックポインタ */
    FP    pc;        /* プログラムカウンタ */
} CTXB;

/*
 * 充り哈みのネスト搀眶のカウント
 */
extern UW interrupt_count;


/*
 *  システム觉轮徊救
 */
Inline UB
current_mode()
{
    return(current_sr() & CPSR_MODE_MASK);
}

Inline BOOL
sense_context()
{
    return(interrupt_count > 0);
}

Inline BOOL
sense_lock()
{
    return(current_sr() & CPSR_IRQ_BIT);
}

#define t_sense_lock    sense_lock
#define i_sense_lock    sense_lock


/*
 *  CPUロックとその豺近
 *
 */

#define t_lock_cpu      lock_cpu
#define i_lock_cpu      lock_cpu
#define t_unlock_cpu    unlock_cpu
#define i_unlock_cpu    unlock_cpu


Inline void
lock_cpu()
{
    disint();
}

Inline void
unlock_cpu()
{
    enaint();
}


/*
 *  タスクディスパッチャ
 */

/*
 *  呵光庭黎界疤タスクへのディスパッチ∈cpu_support.S∷
 *
 *  dispatch は·タスクコンテキストから钙び叫されたサ〖ビスコ〖ル借妄
 *  柒で·CPUロック觉轮で钙び叫さなければならないˉ
 */
extern void    dispatch(void);


/*
 *  附哼のコンテキストを嘉ててディスパッチ∈cpu_support.S∷
 *
 *  exit_and_dispatch は·CPUロック觉轮で钙び叫さなければならないˉ
 */
extern void    exit_and_dispatch(void);


/*
 * 毋嘲ベクタに今き哈まれたジャンプ炭吾が徊救するアドレス
 */
extern UW * arm_vector_add[8];


/*
 * 毋嘲に炳じたハンドラの弹瓢戎孟
 */
extern UW arm_handler_add[8];


/*
 *  CPU毋嘲ハンドラの肋年
 */
extern void define_exc(EXCNO excno, FP exchdr);


Inline void
arm_install_handler(EXCNO excno, FP exchdr)
{
    *arm_vector_add[excno] = (UW)exchdr;
}


/*
 *  CPU毋嘲ハンドラの叫掐庚借妄
 */


/*
 *  CPU毋嘲ハンドラの叫掐庚借妄の栏喇マクロ
 *
 */
#define __EXCHDR_ENTRY(exchdr, stacktop)    \
extern void exchdr##_entry(VP sp);          \
asm(".text                             \n"  \
#exchdr "_entry:                       \n"  \
"       ldr   sp,.int_stack_"#exchdr"  \n"  /* スタックの磊り仑え        */\
"       sub   lr,lr,#4                 \n"  /* undefでもこれでいいか?    */\
"       stmfd sp!, {r0 - r2,lr}        \n"  /* 办箕弄にint_stackに略闰   */ \
"       mrs   r1, spsr                 \n"  /* SVCモ〖ドに磊り仑えるため */ \
"       mov   r0, sp                   \n"  /* 瘦赂する                  */ \
"       mov   r2,#0xd3                 \n"  /* CPSRの今き垂え(SVCモ〖ドへ)*/ \
"       msr   cpsr,r2                  \n" \
"       ldr   r2,[r0,#0x0C]            \n"     /* load  PC            */\
"       stmfd sp!,{r2}                 \n"     /* Store PC            */\
"       stmfd sp!,{r3,ip,lr}           \n"     /* Store r3,ip,lr      */\
"       ldmfd r0!,{r2,ip,lr}           \n"     /* load  r0,r1,r2      */\
"       stmfd sp!,{r1,r2,ip,lr}        \n"     /* SPSR,Store r0,r1,r2 */\
"       ldr   r2, .interrupt_count_"#exchdr"\n" /* 驴脚充り哈みか冉年  */\
"       ldr   r3, [r2]                 \n" \
"       add   r0,r3,#1                 \n" \
"       str   r0, [r2]                 \n" \
"       mov   r0,sp                    \n" /* 毋嘲ハンドラへの苞眶 */\
"       cmp   r3, #0x00                \n" \
"       ldreq   sp,stack_"#exchdr"     \n" /* スタックの恃构       */\
"       stmeqfd sp!,{r0}               \n" /* タスクスタックの瘦赂 */\
"       and   r2, r1, #0xc0            \n" /* 毋嘲券栏箕のCPUロック觉轮(IRQ) */\
"       orr   r2, r2, #0x13            \n" /* とFIQを费镜. SVCモ〖ド */\
"       msr   cpsr,r2                  \n" \
"       bl    "#exchdr"                \n" /* ハンドラ钙び叫し     */\
"       mrs   r2, cpsr                 \n" /* FIQを费镜            */\
"       and   r2, r2, #0x40            \n" /*                      */\
"       orr   r2, r2, #0x93            \n" /* 充り哈み敦贿         */\
"       msr   cpsr,r2                  \n" \
"       ldr   r2,.interrupt_count_"#exchdr" \n"/* 充り哈み搀眶を   */\
"       ldr   r1, [r2]                 \n"     /* デクリメント     */\
"       sub   r3,r1,#1                 \n"\
"       str   r3, [r2]                 \n"\
"       cmp   r3,#0x00                 \n" /* 充り哈みネスト眶?    */\
"       bne   return_to_task_"#exchdr" \n" \
"       ldmfd sp!,{r0}                 \n" /* タスクスタックの牲耽 */\
"       mov   sp, r0                   \n"\
"       ldr   r1, reqflg_"#exchdr"     \n" /* Check reqflg         */\
"       ldr   r0,[r1]                  \n"\
"       cmp   r0,#0                    \n"\
"       beq   return_to_task_"#exchdr" \n"\
"       mov   r0,#0                    \n"\
"       str   r0,[r1]                  \n" /* Clear reqflg   */\
"       b     _kernel_ret_exc          \n" /* ret_intへ      */\
"return_to_task_"#exchdr":             \n" \
"       ldmfd sp!,{r1}                 \n" /* CPSRの牲耽借妄 r1 <- cpsr*/\
"       mrs   r2, cpsr                 \n" /* FIQを费镜            */\
"       and   r2, r2, #0x40            \n" /*                      */\
"       and   r1, r1, #~0x40           \n" /*                      */\
"       orr   r1, r1, r2               \n" /*                      */\
"       msr   spsr, r1                 \n" /* 充り哈み钓材   */\
"       ldmfd sp!,{r0-r3,ip,lr,pc}^    \n"\
"       .align 4                       \n"\
".int_stack_"#exchdr":                 \n"\
"       .long _kernel_int_stack + 6 * 4 \n"\
"reqflg_"#exchdr":                     \n"\
"       .long     _kernel_reqflg       \n"\
"stack_"#exchdr":                      \n"\
"       .long   " #stacktop "          \n"\
".interrupt_count_"#exchdr":            \n"\
"       .long   _kernel_interrupt_count \n")


#define _EXCHDR_ENTRY(exchdr, stacktop)    __EXCHDR_ENTRY(exchdr, stacktop)

#define EXCHDR_ENTRY(exchdr)    _EXCHDR_ENTRY(exchdr, STACKTOP)

#define EXC_ENTRY(exchdr) exchdr##_entry


/*
 *  CPU毋嘲の券栏した箕のシステム觉轮の徊救
 */

/*
 *  CPU毋嘲の券栏した箕のディスパッチ
 */
Inline BOOL
exc_sense_context(VP p_excinf)
{
    return(interrupt_count > 1);    
}


/*
 *  CPU毋嘲の券栏した箕のCPUロック觉轮の徊救
 */
Inline BOOL
exc_sense_lock(VP p_excinf)
{
    return((*((UW *)p_excinf) & CPSR_IRQ_BIT) == CPSR_IRQ_BIT );
}


/*
 * 踏年盗の毋嘲が掐った眷圭
 */
extern void undef_exception();
extern void swi_exception();
extern void prefetch_exception();
extern void data_abort_exception();
extern void irq_abort_exception();
extern void fiq_abort_exception();


/*
 *  プロセッサ巴赂の介袋步
 */
extern void    cpu_initialize(void);


/*
 *  プロセッサ巴赂の姜位箕借妄
 */
extern void    cpu_terminate(void);


/*
 * CPU/充哈みハンドラの叫掐り庚借妄で办箕弄に蝗脱するスタック
 */
#define INT_STACK_SIZE 6
extern UW int_stack[INT_STACK_SIZE];


#endif /* _MACRO_ONLY */
#endif /* _CPU_CONFIG_H_ */