File content as of revision 7:d9aca501126f:

/**
 * @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 = ( value + 100 ) / 200;
        
        
    // 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 ISR_Alarm()
{
    pin_son = 0 ;
    stopTimer2();
    aout =  0.5 ;
 
    pc.printf( "\n\n ERROR: ALARMA \n\n " );
 
}

int getMRvalue( int fout  )
{
    float exact, error;
    int   toRegister;
    
    exact = (24000000 /(fout*2) ) -1;
    toRegister = exact;  // Valor redondeado;
    //error = exact - toRegister;
       
    //pc.printf( "\n\n MR value: %d\n error: %f\n" ,toRegister ,error );
    
    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()
{
    // Arrancar el Timer 2
    LPC_TIM2->TCR = 1;
}

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





/*  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; 
}