source: anotherchoice/tags/jsp-1.4.4-full-UTF8/systask/cxxrt.c@ 363

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *  Copyright (C) 2003-2004 by Takagi Nobuhisa
 * 
 *  上記著作権者
は，以下の (1)〜(4) の条件か，Free Software Foundation 
 *  によってå…
¬è¡¨ã•ã‚Œã¦ã„ã‚‹ GNU General Public License の Version 2 に記
 *  è¿°ã•ã‚Œã¦ã„ã‚‹æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ï¼ˆæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢
 *  を改変したものを含む．以下同じ）を使用・複製・改変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
 *  利用と呼ぶ）することを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
 *      と．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再é…
å¸ƒã®å½¢æ…
‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
 *        å ±å‘Šã™ã‚‹ã“ã¨ï¼Ž
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 * 
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，その適用可能性も
 *  含めて，いかなる保証も行わない．また，本ソフトウェアの利用により直
 *  æŽ¥çš„ã¾ãŸã¯é–“æŽ¥çš„ã«ç”Ÿã˜ãŸã„ã‹ãªã‚‹æå®³ã«é–¢ã—ã¦ã‚‚ï¼Œãã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 * 
 *  @(#) $Id: cxxrt.c,v 1.3 2004/09/17 09:11:44 honda Exp $
 */
#include "../kernel/jsp_kernel.h"
#include "../kernel/task.h"
#include "kernel_id.h"

typedef int _toppers_cxxrt_sync_t;
typedef volatile char _toppers_cxxrt_once_t;

static inline int _get_tid()
{
        return runtsk - tcb_table + TMIN_TSKID;
}

/*
 *      For Syncronization
 */
int _toppers_cxxrt_lock(_toppers_cxxrt_sync_t *sync)
{
        if (iniflg)
                dis_dsp();
        return 0;
}

int _toppers_cxxrt_trylock(_toppers_cxxrt_sync_t *sync)
{
        return _toppers_cxxrt_lock(sync);
}

int _toppers_cxxrt_unlock(_toppers_cxxrt_sync_t *sync)
{
        if (iniflg)
                ena_dsp();
        return 0;
}

int _toppers_cxxrt_get_tskid(void)
{
        return iniflg ? _get_tid() : 0;
}

/*
 *      For recursive semaphore lock
 */
static ID cxxrt_holder;
static UINT cxxrt_counter;

static inline void _toppers_cxxrt_recursive_semaphore_lock(ID semid)
{
        if (iniflg && !sns_dsp())
        {
                ID tskid;
                tskid = _get_tid();

                if (cxxrt_holder != tskid)
                {
                        wai_sem(semid);
                        cxxrt_holder = tskid;
                }
                ++cxxrt_counter;
        }
}

static inline void _toppers_cxxrt_recursive_semaphore_unlock(ID semid)
{
        if (iniflg && !sns_dsp())
        {
                if (--cxxrt_counter == 0)
                {
                        cxxrt_holder = 0;
                        sig_sem(semid);
                }
        }
}


/*
 *      For function call once
 */
int _toppers_cxxrt_once(_toppers_cxxrt_once_t *once, void (*func)(void))
{
        if (!*once)
        {
                static _toppers_cxxrt_sync_t sync;

                _toppers_cxxrt_recursive_semaphore_lock(_CXXRT_SEM);
                if (!*once)
                {
                        (*func)();
                        *once = 1;
                }
                _toppers_cxxrt_recursive_semaphore_unlock(_CXXRT_SEM);
        }
        return 0;
}


/*
 *      For task-local storage
 */
#ifndef CXXRT_KEY_MAX
#define CXXRT_KEY_MAX   2
#endif

struct _toppers_cxxrt_tls
{
        void **data;
        void (*dtor)(void*);
};

extern const ID tmax_tskid;

static void **tls_data[CXXRT_KEY_MAX];
static struct _toppers_cxxrt_tls tls[CXXRT_KEY_MAX];

int _toppers_cxxrt_key_create(struct _toppers_cxxrt_tls **key, void (*dtor)(void*))
{
        struct _toppers_cxxrt_tls *p;

        for (p = &tls[0]; p < &tls[CXXRT_KEY_MAX]; p++)
        {
                if (p->data == NULL)
                {
                        p->data = tls_data[p - &tls[0]];
                        p->dtor = dtor;
                        *key = p;
                        return 0;
                }
        }
        return -1;
}

int _toppers_cxxrt_key_delete(struct _toppers_cxxrt_tls *key)
{
        int i;

        for (i = 0; i <= tmax_tskid; i++)
        {
                if (key->dtor != 0)
                        (*key->dtor)(key->data[i]);
        }
        key->data = NULL;
        key->dtor = 0;
        return 0;
}

/* JSP 1.4との互換性のために_toppers_cxxrt_reset_specificを残しておく */
void _toppers_cxxrt_reset_specific(void)
{
}

void _toppers_cxxrt_init(void)
{
        int i, tmax = tmax_tskid + 1;
        void **p = (void**)malloc(sizeof(void*) * CXXRT_KEY_MAX * tmax);

        for (i = 0; i < CXXRT_KEY_MAX * tmax; i++)
                p[i] = NULL;
        for (i = 0; i < CXXRT_KEY_MAX; i++)
                tls_data[i] = p + i * tmax;
}