profiler.c

6410BSP1

//
// Copyright (c) Microsoft Corporation.  All rights reserved.
//
//
// Use of this source code is subject to the terms of the Microsoft end-user
// license agreement (EULA) under which you licensed this SOFTWARE PRODUCT.
// If you did not accept the terms of the EULA, you are not authorized to use
// this source code. For a copy of the EULA, please see the LICENSE.RTF on your
// install media.
//
//------------------------------------------------------------------------------
//
//  File:  profiler.c
//
//  This file contains implementation of profiler module suitable for the
//  Samsung S3C6410 CPU/SoC with count/compare timer.  The routines
//  use match register 2 (M2) for the profiling timer.
//
#include <windows.h>
#include <nkintr.h>
#include <oal.h>
#include <intr.h>

// Base Definitions
#include "s3c6410_base_regs.h"
#include "s3c6410_pwm.h"
#include "s3c6410_vintr.h"


//------------------------------------------------------------------------------
// Local Variables
static volatile S3C6410_PWM_REG *g_pPWMReg = NULL;

static struct
{
    BOOL enabled;        // is profiler active?
    UINT32 countsPerHit;    // counts per profiler interrupt
} g_profiler;

//------------------------------------------------------------------------------
// External Variables
extern PFN_PROFILER_ISR g_pProfilerISR;

//------------------------------------------------------------------------------
// Local Functions
UINT32 OALProfileIntrHandler(UINT32 ra);

//------------------------------------------------------------------------------
//
//  Function:  ConfigureNextProfilerCount
//
//  Updates the profiler count (prepares the timer for the next timer event).
//
static void ConfigureNextProfilerCount(DWORD dwCountInterval)
{
    DWORD dwTCON;
    
    if (!g_pProfilerISR) return;

    // Change number of timer ticks in the period.
    //
    g_pPWMReg->TCNTB2 = dwCountInterval;

    dwTCON = g_pPWMReg->TCON;
    dwTCON &= ~(0xF << 12);        // stop the timer2
    g_pPWMReg->TCON = dwTCON;

    // Clear Timer2 Interrupt Pending
    //g_pPWMReg->TINT_CSTAT |= (1<<7);        // Do not use OR/AND operation on TINTC_CSTAT
    g_pPWMReg->TINT_CSTAT = TINT_CSTAT_INTMASK(g_pPWMReg->TINT_CSTAT) | TIMER2_PENDING_CLEAR;

    // Enable Timer2 Interrupt
    //g_pPWMReg->TINT_CSTAT |= (1<<2);        // Do not use OR/AND operation on TINTC_CSTAT
    g_pPWMReg->TINT_CSTAT = TINT_CSTAT_INTMASK(g_pPWMReg->TINT_CSTAT) | TIMER2_INTERRUPT_ENABLE;

    // update bit must be cleared when the timer starts.
    g_pPWMReg->TCON = dwTCON | (1 << 13);    // update TCNTB2
    g_pPWMReg->TCON = dwTCON | (1 << 12);    // start timer 2 (one-shot mode)
}

//------------------------------------------------------------------------------
//
//  Function:  OEMProfileTimerEnable
//
//  This function is called by kernel to start kernel profiling timer.
//
VOID OEMProfileTimerEnable(DWORD interval)
{
    BOOL enabled;
    UINT32 Irq;

    OALMSG(OAL_FUNC, (L"+OEMProfileTimerEnable(%d)\r\n", interval));

    // We can't enable timer second time
    if (g_profiler.enabled) return;

    // Obtain a pointer to the PWM registers.
    if (!g_pPWMReg)
    {
        g_pPWMReg = (S3C6410_PWM_REG *)OALPAtoVA(S3C6410_BASE_REG_PA_PWM, FALSE);
    }

    // How many hi-res ticks per profiler hit
    g_profiler.countsPerHit = (g_oalTimer.countsPerMSec*interval)/1000;

    // Following code should not be interrupted
    enabled = INTERRUPTS_ENABLE(FALSE);

    // Configure profiling ISR callback function.
    g_pProfilerISR = OALProfileIntrHandler;

    // Update the compare register for the next profile hit.
    ConfigureNextProfilerCount(g_profiler.countsPerHit);

    // Enable interrupts
    INTERRUPTS_ENABLE(enabled);
    Irq = IRQ_TIMER2;
    OALIntrDoneIrqs(1, &Irq);

    // Set flag
    g_profiler.enabled = TRUE;

    OALMSG(OAL_FUNC, (L"-OEMProfileTimerEnable\r\n"));
}


//------------------------------------------------------------------------------
//
//  Function:  OEMProfileTimerDisable
//
//  This function is called by kernel to stop kernel profiling timer.
//

VOID OEMProfileTimerDisable()
{
    BOOL enabled;
    UINT32 irq;

    OALMSG(OAL_FUNC, (L"+OEMProfileTimerDisable()\r\n"));

    // No disable without enable
    if (!g_profiler.enabled) goto cleanUp;

    // Following code should not be interrupted
    enabled = INTERRUPTS_ENABLE(FALSE);

    // Clear Timer2 Interrupt Pending
    // Do not use OR/AND operation on TINTC_CSTAT
    g_pPWMReg->TINT_CSTAT = TINT_CSTAT_INTMASK(g_pPWMReg->TINT_CSTAT) | TIMER2_PENDING_CLEAR;

    // Disable Timer2 Interrupt
    // Do not use OR/AND operation on TINTC_CSTAT
    g_pPWMReg->TINT_CSTAT = TINT_CSTAT_INTMASK(g_pPWMReg->TINT_CSTAT) & ~TIMER2_INTERRUPT_ENABLE;

    // Disable the profile timer interrupt
    irq = IRQ_TIMER2;
    OALIntrDisableIrqs(1, &irq);

    // Deconfigure profiling ISR callback function.
    g_pProfilerISR = NULL;

    // Reset flag
    g_profiler.enabled = FALSE;

    // Enable interrupts
    INTERRUPTS_ENABLE(enabled);

cleanUp:
    OALMSG(OAL_FUNC, (L"-OEMProfileTimerDisable\r\n"));
}


//------------------------------------------------------------------------------
//
//  Function:  OALProfileIntrHandler
//
//  This is profile timer interrupt handler
//
UINT32 OALProfileIntrHandler(UINT32 ra)
{
    UINT32 Irq;

    // Update the compare register for the next profile hit.
    ConfigureNextProfilerCount(g_profiler.countsPerHit);

    // First call profiler
    ProfilerHit(ra);

    // Enable interrupts
    Irq = IRQ_TIMER2;
    OALIntrDoneIrqs(1, &Irq);

    return(SYSINTR_NOP);
}

//------------------------------------------------------------------------------