File content as of revision 11:30408c8f722a:

/**
 * @brief  Tren de impulsos con Timer2
 * @file   setup.cpp
 * @author Ernesto Palacios
 *
 * Created on 25 de Marzo de 2012
 *
 * Licencia  GPL v3.0
 * http://www.gnu.org/licenses/gpl-3.0.html
 */


#include "setup.h"
#include "mbed.h"

// Salida Serial de mbed
extern Serial pc;
extern DigitalOut   pin_son;   // SON
extern DigitalOut   pin_dir;   // SIGN+
extern InterruptIn  pin_alm;   // ALM 
extern AnalogOut    aout;      // +-10V


void setTimer2()
{
    // Encender Timer2 (PCONP[22])
    LPC_SC->PCONP |= 1 << 22; 

    // Resetear y parar el Timer
    LPC_TIM2->TCR  = 0x2; 
    LPC_TIM2->CTCR = 0x0; 

    // Establecer el Preescaler en cero
    // SIn Preesclaer
    LPC_TIM2->PR = 0;

    // Calcular el periodo Inicial
    uint32_t periodo = ( SystemCoreClock / 400 ); 

    // Establecer los Registros de Coincidencia
    // ( Match Register )
    LPC_TIM2->MR2 = periodo;
    LPC_TIM2->MR3 = periodo;  // Legacy, salidas identicas
    
    LPC_TIM2->MCR |= 1 << 7;    // Resetear Timer en MR2
    
    LPC_TIM2->EMR |= 15UL << 8;  // Alternar Pin MAT2.2 
                                //      y MAT2.3

    LPC_PINCON->PINSEL0 |= 15UL << 16;  //Activar  MAT2.2 
                                      // y MAT2.3 como salidas
   
}

void ISR_Serial()
{
    int value;        // Nuevo Valor
    char command;     // Comando al que aplicar el nuevo valor

    pc.scanf( "%d-%c", &value, &command ) ;
    pc.printf("\n %d-%c \n", value, command );

    // Establecer nueva frecuencia
    if( command == 'H')
        setPTO( value );
    
    else if( command == 'K' )
        setPTO( value * 1000 );
        
    // Nuevo voltaje de salida
    // Alguna formula para calcular el Vout necesario
    // -100% a +100%
    else if( command == 'A')
        aout = (float)( value + 100.0 ) / 200.0;
        
        
    // Cambiar la direccion
    else if( command == 'D')
        pin_dir = value;
        
        
    //Encender el Servo
    else if( command == 'S')
        pin_son = value;
    
    //else if( command == 'E')
      //  setDir( value );
    
}


void setPTO( int freq )
{
    if( freq != 0 )
    {
        LPC_TIM2->TC = 0x00;  //Resetear Timer
        setMR2( getMRvalue( freq ) ); 
        startTimer2();
    
    }else{
        
        stopTimer2();
        LPC_TIM2->TC = 0x00;  //Resetear Timer
    }
}

void setPTO_eth( char * input, char * output )
{
    int freq = atoi( input );
    
    if( freq != 0 ){
        LPC_TIM2->TC = 0x00;            // Resetear Timer
        setMR2( getMRvalue( freq ) );  // Cambiar frefuencia
        startTimer2();                // Iniciar Timer
        sprintf( output, "Ok, Freq = %d", freq );
    
    }else{
        stopTimer2();
        LPC_TIM2->TC = 0x00;  // Resetear Timer
        sprintf( output, "Ok, ALTO" );
    }           
}


void ISR_Alarm()
{
    pin_son = 0 ;
    stopTimer2();
    aout =  0.5 ;
 
    pc.printf( "\n\n ERROR: ALARMA \n\n " );
 
}

int getMRvalue( int fout  )
{
    int   toRegister;
    
    toRegister = (24000000 /(fout*2.0) ) -1;
    return toRegister;
}


void setMR2( int newValue )
{
    LPC_TIM2->MR2 = newValue; // Las dos salidas son identicas
    LPC_TIM2->MR3 = newValue; // Para testear el programa.
}



void startTimer2()
{
    // Arrancer el Timer 2
    LPC_TIM2->TCR = 1;
}

void stopTimer2()
{
    // Detener el Timer 2
    LPC_TIM2->TCR = 0x2;
}


//    **** Funciones Liberia Ethernet  *****   //

void setAout_eth( char * input, char * output )
{
    int    vout = atoi( input );
    aout = (float)( vout + 100 ) / 200;   
    sprintf( output, " Ok, Aout = %f ", aout.read() );    
}



void setDir_eth ( char * input, char * output )
{
    int value = atoi( input );
    
    pin_dir = value;
    
    if( value == 0 )
        sprintf( output,"Derecha" );
    else
        sprintf( output,"Izquierda" );
}



void setSON_eth ( char * input, char * output )
{
    int value = atoi( input );
    
    pin_son = value;
    
    if( value == 0 )
        sprintf( output,"Servo OFF" );
    else
        sprintf( output,"Servo ON" );
        
}



/*  LEGACY FUNCTIONS
 *
 *  El codigo actual no hace referencia a estas funciones
 *  sin embargo no hay problema en definirlas.
 */ 
void setMR3( int newValue )
{
    LPC_TIM2->MR3 = newValue;
}


void setPrescaler( int newValue)
{
    LPC_TIM2->PR = newValue; 
}