source: anotherchoice/tags/jsp-1.4.4-full-UTF8/windev/cmdwatch/cmdwatch.cpp

/*
 *  TOPPERS/JSP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Just Standard Profile Kernel
 * 
 *  Copyright (C) 2003 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: cmdwatch.cpp,v 1.3 2003/06/30 15:51:47 takayuki Exp $
 */

// cmdwatch.cpp : コンソール アプリケーションのエントリ ポイントを定義します。
//

#include <stdio.h>
#include <stdarg.h>

#include <windows.h>
#include <objbase.h>
#include <unknwn.h>
#include <ocidl.h>

#include <conio.h>

#pragma warning(disable:4200) //非標準の拡張機能 : 長さ0のé…
åˆ—ã‚’æŒã¤æ§‹é€ 体

#define TMAX_LOGINFO    8

typedef unsigned int BITMASK;
typedef struct {
                unsigned int    logtype;
                unsigned int    logtim;
                unsigned int    valid;
                unsigned int    bufsz;
                unsigned char   buf[];
        } DBIFLOG;

#define DBIFLOG_BUFMARGIN ((unsigned int)(&((DBIFLOG *)0)->buf))

/*
 *  ログ情
å ±ã®é‡è¦åº¦ã®å®šç¾©
 */
#define LOG_EMERG       0               /* シャットダウンに値するエラー */
#define LOG_ALERT       1
#define LOG_CRIT        2
#define LOG_ERR         3               /* システムエラー */
#define LOG_WARNING     4               /* 警告メッセージ */
#define LOG_NOTICE      5
#define LOG_INFO        6
#define LOG_DEBUG       7               /* デバッグ用メッセージ */

/*
 *  ログ情
å ±ã®é‡è¦åº¦ã®ãƒ“ãƒƒãƒˆãƒžãƒƒãƒ—ã‚’ä½œã‚‹ãŸã‚ã®ãƒžã‚¯ãƒ­
 */
#define LOG_MASK(prio)  (1 << (prio))
#define LOG_UPTO(prio)  ((1 << ((prio) + 1)) - 1)

/*
 *  ログ情
å ±ã®ç¨®åˆ¥ã®å®šç¾©
 */
#define LOG_TYP_INTERRUPT       0x01    /* 割込みハンドラ */
#define LOG_TYP_ISR                     0x02    /* 割込みサービスハンドラ */
#define LOG_TYP_TIMERHDR        0x03    /* タイムイベントハンドラ */
#define LOG_TYP_CPUEXC          0x04    /* CPU例外ハンドラ */
#define LOG_TYP_TSKEXC          0x05    /* タスク例外処理ルーチン */
#define LOG_TYP_TSKSTAT         0x06    /* タスク状æ…
‹å¤‰åŒ– */
#define LOG_TYP_DISPATCH        0x07    /* ディスパッチャ */
#define LOG_TYP_SVC                     0x08    /* サービスコール */
#define LOG_TYP_COMMENT         0x09    /* コメント（文字列のみのログ） */
#define LOG_ENTER                       0x00    /* å…
¥å£ï¼é–‹å§‹ */
#define LOG_LEAVE                       0x80    /* 出口／終了 */



static FILE * destination = NULL;

static const char * apiname[] = 
{ "cre_tsk","del_tsk","act_tsk","can_act","sta_tsk","ext_tsk","exd_tsk","ter_tsk","chg_pri","get_pri","ref_tsk","ref_tst","slp_tsk","tslp_tsk","wup_tsk","can_wup","rel_wai","sus_tsk","rsm_tsk","frsm_tsk","dly_tsk","","def_tex","ras_tex","dis_tex","ena_tex","sns_tex","ref_tex","cre_sem","del_sem","sig_sem","","wai_sem","pol_sem","twai_sem","ref_sem","cre_flg","del_flg","set_flg","clr_flg","wai_flg","pol_flg","twai_flg","ref_flg","cre_dtq","del_dtq","","","snd_dtq","psnd_dtq","tsnd_dtq","fsnd_dtq","rcv_dtq","prcv_dtq","trcv_dtq","ref_dtq","cre_mbx","del_mbx","snd_mbx","","rcv_mbx","prcv_mbx","trcv_mbx","ref_mbx","cre_mpf","del_mpf","rel_mpf","","get_mpf","pget_mpf","tget_mpf","ref_mpf","set_tim","get_tim","cre_cyc","del_cyc","sta_cyc","stp_cyc","ref_cyc","","rot_rdq","get_tid","","","loc_cpu","unl_cpu","dis_dsp","ena_dsp","sns_ctx","sns_loc","sns_dsp","sns_dpn","ref_sys","","","","def_inh","cre_isr","del_isr","ref_isr","dis_int","ena_int","chg_ixx","get_ixx","def_svc","def_exc","ref_cfg","ref_ver","iact_tsk","iwup_tsk","irel_wai","iras_tex","isig_sem","iset_flg","ipsnd_dtq","ifsnd_dtq","irot_rdq","iget_tid","iloc_cpu","iunl_cpu","isig_tim","","","","cre_mtx","del_mtx","unl_mtx","","loc_mtx","ploc_mtx","tloc_mtx","ref_mtx","cre_mbf","del_mbf","","","snd_mbf","psnd_mbf","tsnd_mbf" };



void Printf(const char * format, ... )
{
        va_list vl;
        char buffer[1024];
        int i;

        va_start(vl,format);
        i = ::vsprintf(buffer, format, vl);
        if(destination != NULL)
                fwrite(buffer, i, 1, destination);
        fwrite(buffer, i, 1, stdout);
}

const char * get_apiname(int fncd)
{       return apiname[-5 - fncd];      };

void print_log(DBIFLOG * log)
{
        int i;

        Printf("%10d ms : ",log->logtim);
        switch(log->logtype)
        {
        case LOG_TYP_SVC:
                Printf("[SVC|ENT] %s (",get_apiname(*(int*)log->buf));

                for(i=0;i < *((int*)log->buf+1);i++)
                {
                        if(i!=0)
                                Printf(", ");
                        Printf("0x%08x",*((int*)log->buf+2+i));
                }
                Printf(")\n");
                break;

        case LOG_TYP_SVC|LOG_LEAVE:
                Printf("[SVC|LEA] %s",get_apiname(*(int*)log->buf));
                if(*((int*)log->buf+1) > 0)
                        Printf(" (ercd = 0x%08x)",*((int*)log->buf+2));
                Printf("\n");
                break;

        case LOG_TYP_TSKSTAT:
                Printf("[TSKSTAT] Tsk:%d ",*(int*)log->buf);
                switch(*((int*)log->buf+1))
                {
                case 0x01:
                case 0x02:
                        Printf("<Ready>\n",*(int*)log->buf);
                        break;
                case 0x04:
                case 0x0c:
                        if(*((int*)log->buf+1) == 0x04)
                                Printf("<Waiting : ");
                        else
                                Printf("<Wait-Suspend : ");

                        switch(*((int*)log->buf+2))
                        {
                        case 0x1:
                                Printf("Sleep>\n");
                                break;
                        case 0x2:
                                Printf("Delay>\n");
                                break;
                        case 0x4:
                                Printf("Semaphore (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x8:
                                Printf("Eventflag (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x10:
                                Printf("Dataqueue[send] (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x20:
                                Printf("Dataqueue[receive] (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x40:
                                Printf("Mailbox (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x80:
                                Printf("Mutex (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x100:
                                Printf("MessageBuffer[send] (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x200:
                                Printf("MessageBuffer[receive] (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x400:
                                Printf("Rendezvous[call] (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x800:
                                Printf("Rendezvous[accept] (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x1000:
                                Printf("Rendezvous[completion] (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x2000:
                                Printf("Fixed Memorypool (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        case 0x4000:
                                Printf("Variable Memorypool (id=%d)>\n",*((int*)log->buf+3));
                                break;
                        default:
                                Printf(" complex [%04x]>\n", *((int*)log->buf+2));
                                break;
                        }
                        break;

                case 0x08:
                        Printf("<Suspended>\n");
                        break;
                case 0x10:
                        Printf("<Dormant>\n");
                        break;
                default:
                        Printf("<Unknown : %d>",*(int*)log->buf);
                        break;
                }
                break;

        case LOG_TYP_TSKEXC:
                Printf("[TEX|ENT] Tsk:%d\n",*(int*)log->buf);
                break;

        case LOG_TYP_TSKEXC | LOG_LEAVE:
                Printf("[TEX|LEA] Tsk:%d\n",*(int*)log->buf);
                break;

        case LOG_TYP_DISPATCH:
                if(*((int*)log->buf+1) == 0)
                        Printf("[DSP|ENT] Tsk:%d Task-context\n",*(int*)log->buf);
                else
                        Printf("[DSP|ENT] Tsk:%d Nontask-context\n",*(int*)log->buf);
                break;

        case LOG_TYP_DISPATCH | LOG_LEAVE:
                Printf("[DSP|LEA] Tsk:%d\n",*(int*)log->buf);           
                break;

        case LOG_TYP_COMMENT:
                *((char *)log->buf + log->bufsz -1) = '\x0';
                Printf("[COMMENT](%d) : <%s>\n",*(int *)log->buf,log->buf+sizeof(int));
                break;
        
        case LOG_TYP_INTERRUPT:
                Printf("[INT|ENT] %d\n",*(int*)log->buf);
                break;

        case LOG_TYP_INTERRUPT | LOG_LEAVE:
                Printf("[INT|LEA] %d\n",*(int*)log->buf);
                break;

        case LOG_TYP_CPUEXC:
                Printf("[CEX|ENT] Tsk:%d\n",*(int*)log->buf);
                break;

        case LOG_TYP_CPUEXC | LOG_LEAVE:
                Printf("[CEX|LEA] Tsk:%d\n",*(int*)log->buf);
                break;

        case LOG_TYP_TIMERHDR:
        case LOG_TYP_TIMERHDR | LOG_LEAVE:
                if((log->logtype & LOG_LEAVE) != 0)
                        Printf("[INT|LEA]");
                else
                        Printf("[INT|ENT]");

                if( *(int*)log->buf == 0x8d )
                        Printf(" cyclic ");
                else
                        Printf(" OBJ(%02x) ", *(int*)log->buf);

                Printf(" ID:%d  EXINF:0x%08x\n",*((int*)log->buf+1), *((int*)log->buf+2));
                break;

        default:
                Printf("[UNKNOWN] : 0x%x\n",log->logtype);
        };
}




const CLSID CLSID_KernelLog = {0x4BD327FC,0x9E4A,0x4A5D,{0x95,0x03,0x27,0xC9,0x79,0xA8,0xE8,0x02}};

MIDL_INTERFACE("395F900A-AC7E-4A78-9BC1-EE5EF76254FF")
IKernelLog : public IUnknown
{
public:
};


struct __declspec(uuid("35E35399-55ED-45FC-8F0B-4A1BC6CEA3F0")) _IKernelLogEvents;

class IKernelLogEvents : public IUnknown
{
public:
        STDMETHOD(QueryInterface)(REFIID, void **);
        STDMETHOD_(ULONG,AddRef)();
        STDMETHOD_(ULONG,Release)();
    virtual HRESULT STDMETHODCALLTYPE OnKernelStart(void);
    virtual HRESULT STDMETHODCALLTYPE OnKernelExit(void);
    virtual HRESULT STDMETHODCALLTYPE OnLogEvent(long sz, byte __RPC_FAR data[]);

        IKernelLogEvents(void)  { RefCount = 0; };
//      virtual ~IKernelLogEvents(void) {       if(destination != NULL) fclose(destination); };

        LONG RefCount;
};

HRESULT IKernelLogEvents::QueryInterface(REFIID riid, void ** ppvObject)
{
        if( riid == __uuidof(_IKernelLogEvents) || riid == __uuidof(IUnknown) )
        {
                *ppvObject = this;
                ::InterlockedIncrement(&RefCount);
                return S_OK;
        }

        return E_NOINTERFACE;
}

ULONG IKernelLogEvents::AddRef(void)
{       return ::InterlockedIncrement(&RefCount);       }

ULONG IKernelLogEvents::Release(void)
{
        if( ::InterlockedDecrement(&RefCount) == 0 )
        {
                delete this;
                return 0;
        }
        return RefCount;
}

HRESULT IKernelLogEvents::OnKernelExit(void)
{
        Printf("OnKernelExit at \n");

        if(destination != NULL)
        {
                fclose(destination);
                destination = 0;
        }
        return S_OK;
}

HRESULT IKernelLogEvents::OnKernelStart(void)
{
        char buffer[256];
        SYSTEMTIME systim;

        if(destination != NULL)
                fclose(destination);

        ::GetLocalTime(&systim);
        ::wsprintf(buffer, "kernel-log-%04d%02d%02d-%02d%02d%02d.txt", systim.wYear, systim.wMonth, systim.wDay, systim.wHour, systim.wMinute, systim.wSecond);
        destination = fopen(buffer, "wt");

        Printf("OnKernelStart\n");
        return S_OK;
}

HRESULT IKernelLogEvents::OnLogEvent(long sz, byte data [])
{
        print_log((DBIFLOG *)data);
        return S_OK;
}


        //コネクションポイントへの接続
bool Advise(IUnknown * container, REFIID iid, IUnknown * sink, DWORD * cookie, IConnectionPoint ** pcp = NULL)
{
        IConnectionPointContainer * cpc;
        IConnectionPoint * cp;

        HRESULT result;

        if(pcp == NULL)
                pcp = &cp;

        container->QueryInterface(IID_IConnectionPointContainer, (void **)&cpc);
        if(cpc == 0)
                return false;

        cpc->FindConnectionPoint(iid, pcp);
        cpc->Release();
        if(*pcp == 0)
                return false;

        if(FAILED(result = (*pcp)->Advise(sink, cookie)))
                return false;

        if(pcp == &cp)
                cp->Release();
        return true;
}

DWORD tmain_threadid;

BOOL WINAPI HandlerRoutine(DWORD dwCtrlType)
{
        switch(dwCtrlType)
        {
        case CTRL_C_EVENT:
                ::PostThreadMessage(tmain_threadid,WM_QUIT,0,0);
                break;
        default:
                return FALSE;
        }

        return TRUE;
}

int main(int argc, char * argv[])
{
        IKernelLog *            pKernelLog;
        IKernelLogEvents *      psKernelLogEvents;
        IConnectionPoint *      cp;
        DWORD                           cookie;
        MSG msg;

        IKernelLogEvents a;

        ::CoInitialize(NULL);

        destination = 0;
        tmain_threadid = ::GetCurrentThreadId();

        if(!FAILED(::CoCreateInstance(CLSID_KernelLog, NULL, CLSCTX_ALL, __uuidof(IKernelLog), (void **)&pKernelLog)))
        {
                cp = NULL;
                psKernelLogEvents = new IKernelLogEvents;

                if(Advise(pKernelLog, __uuidof(_IKernelLogEvents), psKernelLogEvents, &cookie, &cp))
                {
                        ::SetConsoleCtrlHandler(HandlerRoutine, TRUE);
                        while(::GetMessage(&msg, NULL, 0, 0) != 0)
                        {   ::DispatchMessage(&msg);   }
                        ::SetConsoleCtrlHandler(HandlerRoutine, FALSE);
                        
                        cp->Unadvise(cookie);
                }

                delete psKernelLogEvents;

                if(pKernelLog != NULL)
                        pKernelLog->Release();
        }

        if(destination != NULL)
        {
                Printf("\n\nSuspended by Ctrl-C event occursion.\n");
                fclose(destination);
        }

        ::CoUninitialize();
        return 0;
}