Util_spe.c

Go to the documentation of this file.

/****************** COPYRIGHT (C) 2007-2013 KEOLABS S.A.S. ********************/
/******************************************************************************/

/* Includes ------------------------------------------------------------------*/
#include "circle.h"


/* Private defines -----------------------------------------------------------*/
#define TIMER_MULT_RATIO 110
#define TIMER_DIV_RATIO 200

/* Private typedef -----------------------------------------------------------*/

/* Private variables ---------------------------------------------------------*/
u32                  CurrentTimerDelay = 0;
void ( *CurrentEventTimer )( void ) = 0;

/* Private function prototypes -----------------------------------------------*/

/* Private functions ---------------------------------------------------------*/
void fct_dummy() {;}

/* External variables ---------------------------------------------------------*/

/* Public functions ----------------------------------------------------------*/

/*******************************************************************************
*
*                    delayms
*
*******************************************************************************/
/******************************************************************************/
void Delayms( u32 nTime )
{
    TimingDelay = nTime;

    while ( TimingDelay != 0 );
}

void delay( s32 count )
{
    volatile s32 i, j;
    for ( i = 0; i < count; i++ )
        for ( j = 0; j < 1300; j++ )
            fct_dummy();
}

/*******************************************************************************
*
*                                starting_delay
*
*******************************************************************************/
/*******************************************************************************/
void starting_delay( void )
{
    delay( 100 );
}

/******************************************************************************
*
*                                Sleep_Call
*
******************************************************************************/
/* To respect Misra rule 3 :  */
/*"Assembly language functions that are called from C should be written as C functions containing only in-line assembly language.  */
/*In-line assembly language should not be embedded in normal C code."  */
void Sleep_Call( void )
{
    asm( "wfi" );
}

/*******************************************************************************
*
*                                UTIL_LoadApp
*
*******************************************************************************/
/********************************************************************************/
void UTIL_LoadApp( index_t app )
{
}


/*******************************************************************************
*
*                                my_strlen
*
*******************************************************************************/
/******************************************************************************/
len_t my_strlen( const u8* p )
{
    len_t len = 0;

    for ( ; *p; p++ )
    {
        len++;
    }

    return len;
}



/*******************************************************************************
*
*                    UTIL_GetUsb
*
*******************************************************************************/
/******************************************************************************/
u8 UTIL_GetUsb( void )
{
    return ( GPIO_ReadInputDataBit( USB_DISCONNECT_PORT, USB_DISCONNECT_PIN ) == Bit_SET );
}


/*******************************************************************************
*
*                                UTIL_SetIrqHandler
*
*******************************************************************************/
/********************************************************************************/
void UTIL_SetIrqHandler( s32 Offs, tHandler pHDL )
{
    if ( ( Offs >= 8 ) && ( Offs < 0x180 ) ) // YRT20110627 - Changed for F200
        *( tHandler* )( CIRCLEOS_RAM_BASE + Offs ) = pHDL;
}

/*******************************************************************************
*
*                                UTIL_GetIrqHandler
*
*******************************************************************************/
/********************************************************************************/
tHandler UTIL_GetIrqHandler( s32 Offs )
{
    if ( ( Offs >= 8 ) && ( Offs < 0x180 ) ) // YRT20110627 - Changed for F200
        return *( tHandler* )( CIRCLEOS_RAM_BASE + Offs );
    else
        return 0;
}

/*******************************************************************************
*
*                                UTIL_GetAppAddress
*
*******************************************************************************/
/********************************************************************************/
uint_t UTIL_GetAppAddress( const u8* AppName )
{
    s32 i;

    for ( i = 0; i < MAXAPP; i++ )
    {
        tMenuItem*  curapp;
        long unsigned addr;

        if ( ( *ApplicationTable )[ -i ] == APP_VOID )
        {
            break;
        }
        else
        {
            addr   = ( long unsigned )( *ApplicationTable )[ -i ] ;
            //~ addr &= 0x00FFFFFF;     //YRT130802 new FAT with complete address
            //~ addr |= 0x08000000;
            curapp = ( tMenuItem* ) addr;
            if ( !strcmp( curapp->Text, AppName ) )
            {
                return addr;
            }
        }
    }

    return 0;
}

/*******************************************************************************
*
*                                UTIL_SetTimer
*
*******************************************************************************/
/********************************************************************************/
void UTIL_SetTimer( u32 millisec,  void ( *fTimerHandler )( void ) )
{
    CurrentTimerDelay = ( millisec * TIMER_MULT_RATIO ) / TIMER_DIV_RATIO ;
    if ( !CurrentTimerDelay )
        CurrentTimerDelay = 1;
    
    CurrentTimerDelay = ( CurrentTimerDelay * freqTIM2[CurrentSpeed] ) / freqTIM2[SPEED_MEDIUM];
    CurrentEventTimer = fTimerHandler ;
    
    return;
}