source: mypx/arch/m68k_gcc/prc_insn.h

/*
 *  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-2007 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ÍÑ¡Ë
 */

#ifndef TOPPERS_PRC_INSN_H
#define TOPPERS_PRC_INSN_H

/*
 *  ¥¹¥Æ¡Œ¥¿¥¹¥ì¥ž¥¹¥¿¡ÊSR¡Ë€ÎžœºßÃÍ€ÎÆɜЀ·
 */
Inline uint16_t
current_sr(void)
{
        uint16_t        sr;

        Asm("move.w %%sr, %0" : "=g"(sr));
        return(sr);
}

/*
 *  ¥¹¥Æ¡Œ¥¿¥¹¥ì¥ž¥¹¥¿¡ÊSR¡Ë€ÎžœºßÃÍ€ÎÀßÄê
 */
Inline void
set_sr(uint16_t sr)
{
        Asm("move.w %0, %%sr" : : "g"(sr) : "cc");
}

/*
 *  NMI€òœü€¯€¹€Ù€Æ€Î³ä¹þ€ß€Î¶Ø»ß
 *
 *  set_sr€òÍÑ€€€ÆŒÂžœ€¹€ë€³€È€â€Ç€­€ë€¬¡€ÊÌ€ÎÌ¿Îá€òÍÑ€€€ÆŒÂžœ€·€¿Êý€¬
 *  žúΚ€¬ÎÉ€€€¿€á€ËÍÑ°Õ€·€Æ€€€ë¡¥
 */
Inline void
disint(void)
{
        Asm("or.w #0x0700, %sr");
}

/*
 *  €¹€Ù€Æ€Î³ä¹þ€ß€Îµö²Ä
 *
 *  set_sr€òÍÑ€€€ÆŒÂžœ€¹€ë€³€È€â€Ç€­€ë€¬¡€ÊÌ€ÎÌ¿Îá€òÍÑ€€€ÆŒÂžœ€·€¿Êý€¬
 *  žúΚ€¬ÎÉ€€€¿€á€ËÍÑ°Õ€·€Æ€€€ë¡¥
 */
Inline void
enaint(void)
{
        Asm("and.w #~0x0700, %sr");
}

/*
 *  ¥Ù¥¯¥¿¥Ù¡Œ¥¹¥ì¥ž¥¹¥¿¡ÊVBR¡Ë€ÎžœºßÃÍ€ÎÆɜЀ·
 */
Inline void
*current_vbr(void)
{
        void    *vbr;

        Asm("movec.l %%vbr, %0" : "=r"(vbr));
        return(vbr);
}

/*
 *  ¥Ù¥¯¥¿¥Ù¡Œ¥¹¥ì¥ž¥¹¥¿¡ÊVBR¡Ë€ÎžœºßÃÍ€ÎÀßÄê
 */
Inline void
set_vbr(void *vbr)
{
        Asm("movec.l %0, %%vbr" : : "r"(vbr));
}

/*
 *  ¥ì¥Ç¥£¥­¥å¡Œ¥µ¡Œ¥Á€Î€¿€á€Î¥Ó¥Ã¥È¥Þ¥Ã¥×¥µ¡Œ¥ÁŽØ¿ô
 *
 *  bfffoÌ¿Îá€ÏºÇŸå°Ì¥Ó¥Ã¥È€«€é¥µ¡Œ¥Á€¹€ë€¿€á¡€ºÇŸå°Ì¥Ó¥Ã¥È€òºÇ¹âÍ¥ÀèÅÙ
 *  €ËÂбþ€µ€»€ë¡¥
 */
#define OMIT_BITMAP_SEARCH
#define PRIMAP_BIT(pri)         (0x8000U >> (pri))

Inline uint_t
bitmap_search(uint16_t bitmap)
{
        uint32_t        offset;

        Asm("bfffo %1{16,16}, %0" : "=d"(offset) : "d"((uint32_t) bitmap));
        return((uint_t)(offset - 16));
}

#endif /* TOPPERS_PRC_INSN_H */