evm5509_led.c

来自「dsp 5509a MMC 卡 ID号读取 12Mhzx16=192M」· C语言 代码 · 共 61 行

/*
 *  Copyright 2002 by Spectrum Digital Incorporated.
 *  All rights reserved. Property of Spectrum Digital Incorporated.
 */
 
/*
 *  ======== evm5509_led.c ========
 *  LED module for the EVM5509
 */
 
#include <csl.h>

#include "evm5509.h"
#include "evm5509_led.h"

static Int16 ledstate;

void EVM5509_LED_init()
{
    /* Turn all LEDs off */
    ledstate = 0;
    EVM5509_rset(EVM5509_USER_REG, ledstate);
}

void EVM5509_LED_off(Uint32 ledNum)
{
    /* Check bounds for ledNum */
    if (ledNum >= 4)
        return;
       
    /* Clear the LED bit */
    ledstate &= ~(1 << ledNum);
    EVM5509_rset(EVM5509_USER_REG, ledstate);
}

void EVM5509_LED_on(Uint32 ledNum)
{
    /* Check bounds for ledNum */
    if (ledNum >= 4)
        return;
        
    /* Set the LED bit */
    ledstate |= 1 << ledNum;
    EVM5509_rset(EVM5509_USER_REG, ledstate);
}

void EVM5509_LED_toggle(Uint32 ledNum)
{
    /* Check bounds for ledNum */
    if (ledNum >= 4)
        return;
        
    /* Toggle the LED bit */
    if ((EVM5509_rget(EVM5509_USER_REG) & (1 << ledNum)) == 0)
        EVM5509_LED_on(ledNum);
    else
        EVM5509_LED_off(ledNum);
}