Proyecto de Tesis en Mecatrónica. Universidad Técnica del Norte. Ernesto Palacios <mecatronica.mid@gmail.com>
Dependencies: EthernetNetIf HTTPServer QEI_hw RPCInterface mbed
setup.cpp
- Committer:
- Yo_Robot
- Date:
- 2012-04-21
- Revision:
- 14:039d070732d5
- Parent:
- 12:c02b08dacc45
- Child:
- 15:a1ffa32ce9d1
File content as of revision 14:039d070732d5:
/** * @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 + 10000.0 ) / 20000.0; // Cambiar la direccion else if( command == 'D') { stopTimer2(); pin_dir = value; wait_us( 2 ); startTimer2(); } //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 if( pin_alm == 0 ) sprintf( output,"Ok" ); else sprintf( output,"AL" ); }else{ stopTimer2(); LPC_TIM2->TC = 0x00; // Resetear Timer if( pin_alm == 0 ) sprintf( output,"Ok" ); else sprintf( output,"AL" ); } } void ISR_Alarm() { pin_son = 0 ; stopTimer2(); aout = 0.5 ; pc.printf( "ERROR_ALARMA" ); } 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 + 10000 ) / 20000; if( pin_alm == 0 ) sprintf( output,"Ok" ); else sprintf( output,"AL" ); } void setDir_eth ( char * input, char * output ) { int value = atoi( input ); pin_dir = value; if( pin_alm == 0 ) sprintf( output,"Ok" ); else sprintf( output,"AL" ); } void setSON_eth ( char * input, char * output ) { int value = atoi( input ); pin_son = value; if( pin_alm == 0 ) sprintf( output,"Ok" ); else sprintf( output,"AL" ); } /* 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; }