source: mypx/arch/m68k_gcc/prc_config.c

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *  Copyright (C) 2005-2009 by Embedded and Real-Time Systems Laboratory
 *              Graduate School of Information Science, Nagoya Univ., JAPAN
 * 
 *  Ÿåµ­Ãøºîž¢ŒÔ€Ï¡€°Ê²Œ€Î(1)¡Á(4)€ÎŸò·ï€òËþ€¿€¹Ÿì¹ç€ËžÂ€ê¡€ËÜ¥œ¥Õ¥È¥Š¥§
 *  ¥¢¡ÊËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò²þÊÑ€·€¿€â€Î€òŽÞ€à¡¥°Ê²ŒÆ±€ž¡Ë€ò»ÈÍÑ¡ŠÊ£Àœ¡Š²þ
 *  ÊÑ¡ŠºÆÇÛÉۡʰʲŒ¡€ÍøÍрȞƀ֡ˀ¹€ë€³€È€ò̵œþ€ÇµöÂú€¹€ë¡¥
 *  (1) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¥œ¡Œ¥¹¥³¡Œ¥É€Î·Á€ÇÍøÍÑ€¹€ëŸì¹ç€Ë€Ï¡€Ÿåµ­€ÎÃøºî
 *      ž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äꀬ¡€€œ€Î€Þ€Þ€Î·Á€Ç¥œ¡Œ
 *      ¥¹¥³¡Œ¥ÉÃæ€ËŽÞ€Þ€ì€Æ€€€ë€³€È¡¥
 *  (2) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€¥é¥€¥Ö¥é¥ê·ÁŒ°€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
 *      Íрǀ­€ë·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍÑ
 *      ŒÔ¥Þ¥Ë¥å¥¢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃøºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­
 *      €Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
 *  (3) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€µ¡Žï€ËÁȀ߹þ€à€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
 *      Íрǀ­€Ê€€·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€Œ¡€Î€€€º€ì€«€ÎŸò·ï€òËþ€¿€¹€³
 *      €È¡¥
 *    (a) ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍьԥޥ˥奢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃø
 *        ºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
 *    (b) ºÆÇÛÉۀηÁÂÖ€ò¡€ÊÌ€ËÄê€á€ëÊýË¡€Ë€è€Ã€Æ¡€TOPPERS¥×¥í¥ž¥§¥¯¥È€Ë
 *        Êó¹ð€¹€ë€³€È¡¥
 *  (4) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€ë€€€«€Ê€ë»
 *      ³²€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€òÌÈÀÕ€¹€ë€³€È¡¥
 *      €Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Î¥æ¡Œ¥¶€Þ€¿€Ï¥š¥ó¥É¥æ¡Œ¥¶€«€é€Î€€€«€Ê€ëÍý
 *      ͳ€ËŽð€Å€¯ÀÁµá€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€ò
 *      ÌÈÀÕ€¹€ë€³€È¡¥
 * 
 *  ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Ï¡€ÌµÊÝŸÚ€ÇÄ󶡀µ€ì€Æ€€€ë€â€Î€Ç€¢€ë¡¥Ÿåµ­Ãøºîž¢ŒÔ€ª
 *  €è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€Ï¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ËŽØ€·€Æ¡€ÆÃÄê€Î»ÈÍÑÌÜŪ
 *  €ËÂЀ¹€ëŬ¹çÀ­€âŽÞ€á€Æ¡€€€€«€Ê€ëÊÝŸÚ€â¹Ô€ï€Ê€€¡¥€Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§
 *  ¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€¿€€€«€Ê€ë»³²€ËŽØ€·€Æ€â¡€€œ
 *  €ÎÀÕÇ€€òÉé€ï€Ê€€¡¥
 * 
 *  @(#) $Id$
 */

/*
 *              ¥×¥í¥»¥Ã¥µ°Íž¥â¥ž¥å¡Œ¥ë¡ÊM68040ÍÑ¡Ë
 */

#include "kernel_impl.h"
#include "check.h"
#include "task.h"

/*
 *  CPU¥í¥Ã¥¯¥Õ¥é¥°ŒÂžœ€Î€¿€á€ÎÊÑ¿ô
 */
volatile bool_t         lock_flag;              /* CPU¥í¥Ã¥¯¥Õ¥é¥°€ÎÃÍ€òÊÝ»ý€¹€ëÊÑ¿ô */
volatile uint16_t       saved_iipm;             /* ³ä¹þ€ßÍ¥ÀèÅÙ¥Þ¥¹¥¯€òÊÝž€¹€ëÊÑ¿ô */

/*
 *  ¥×¥í¥»¥Ã¥µ°Íž€ÎœéŽü²œ
 */
void
prc_initialize(void)
{
        /*
         *  CPU¥í¥Ã¥¯¥Õ¥é¥°ŒÂžœ€Î€¿€á€ÎÊÑ¿ô€ÎœéŽü²œ
         */
        lock_flag = true;
        saved_iipm = IIPM_ENAALL;

        /*
         *  Îã³°¥Ù¥¯¥¿¥Æ¡Œ¥Ö¥ë€ÎœéŽü²œ
         */
#ifdef EXCVT_KERNEL
        memcpy(EXCVT_KERNEL, EXCVT_ORIG, EXCVT_LEN);
        set_vbr(EXCVT_KERNEL);
#endif /* EXCVT_KERNEL */
}

/*
 *  ¥×¥í¥»¥Ã¥µ°Íž€ÎœªÎ»œèÍý
 */
void
prc_terminate(void)
{
        extern void     software_term_hook(void);
        void (*volatile fp)(void) = software_term_hook;

        /*
         *  software_term_hook€Ø€Î¥Ý¥€¥ó¥¿€ò¡€°ìövolatile»ØÄê€Î€¢€ëfp€ËÂå
         *  Æþ€·€Æ€«€é»È€Š€Î€Ï¡€0€È€ÎÈæ³Ó€¬ºÇŬ²œ€Çºïœü€µ€ì€Ê€€€è€Š€Ë€¹€ë€¿
         *  €á€Ç€¢€ë¡¥
         */
        if (fp != 0) {
                (*fp)();
        }

#ifdef EXCVT_KERNEL
        set_vbr(EXCVT_ORIG);
#endif /* EXCVT_KERNEL */
}

/*
 *  CPUÎã³°€ÎȯÀžŸõ¶·€Î¥í¥°œÐÎÏ
 *
 *  CPUÎã³°¥Ï¥ó¥É¥é€ÎÃ怫€é¡€CPUÎã³°ŸðÊó¥Ý¥€¥ó¥¿¡Êp_excinf¡Ë€ò°ú¿ô€È€·
 *  €ÆžÆ€ÓœÐ€¹€³€È€Ç¡€CPUÎã³°€ÎȯÀžŸõ¶·€ò¥·¥¹¥Æ¥à¥í¥°€ËœÐÎÏ€¹€ë¡¥
 */
#ifdef SUPPORT_XLOG_SYS

void
xlog_sys(void *p_excinf)
{
        char    *excsp = (char *) p_excinf;
        uint_t  format;

        syslog_0(LOG_ERROR, "CPU Exception Information:");
        syslog_4(LOG_ERROR, "SR = %04x (M = %d, S = %d, IPM = %d)",
                                *((uint16_t *) excsp),
                                (*((uint16_t *) excsp) & 0x1000U) >> 12,
                                (*((uint16_t *) excsp) & 0x2000U) >> 13,
                                (*((uint16_t *) excsp) & 0x0700U) >> 8);
        syslog_1(LOG_ERROR, "PC = %08x", *((uint32_t *)(excsp + 2)));
        format = (*((uint16_t *)(excsp + 6)) & 0xf000U) >> 12;
        syslog_2(LOG_ERROR, "Format = %d, Vector Offset = %03x",
                                format, (*((uint16_t *)(excsp + 6)) & 0x0fffU));
        if (format >= 2U) {
                syslog_1(LOG_ERROR, "ADR = %08x", *((uint32_t *)(excsp + 8)));
        }
}

#endif /* SUPPORT_XLOG_SYS */