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@10:0ebc4955cbe7, 2012-04-03 (annotated)
- Committer:
- Yo_Robot
- Date:
- Tue Apr 03 01:08:11 2012 +0000
- Revision:
- 10:0ebc4955cbe7
- Parent:
- 7:d9aca501126f
- Child:
- 11:30408c8f722a
v0.21 Serial No RPC. Pequeos cambios
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Yo_Robot | 4:552beeda4722 | 1 | /** |
Yo_Robot | 4:552beeda4722 | 2 | * @brief Tren de impulsos con Timer2 |
Yo_Robot | 4:552beeda4722 | 3 | * @file setup.cpp |
Yo_Robot | 4:552beeda4722 | 4 | * @author Ernesto Palacios |
Yo_Robot | 4:552beeda4722 | 5 | * |
Yo_Robot | 4:552beeda4722 | 6 | * Created on 25 de Marzo de 2012 |
Yo_Robot | 4:552beeda4722 | 7 | * |
Yo_Robot | 4:552beeda4722 | 8 | * Licencia GPL v3.0 |
Yo_Robot | 4:552beeda4722 | 9 | * http://www.gnu.org/licenses/gpl-3.0.html |
Yo_Robot | 4:552beeda4722 | 10 | */ |
Yo_Robot | 4:552beeda4722 | 11 | |
Yo_Robot | 3:8d5a9e3cd680 | 12 | |
Yo_Robot | 3:8d5a9e3cd680 | 13 | #include "setup.h" |
Yo_Robot | 3:8d5a9e3cd680 | 14 | #include "mbed.h" |
Yo_Robot | 3:8d5a9e3cd680 | 15 | |
Yo_Robot | 3:8d5a9e3cd680 | 16 | // Salida Serial de mbed |
Yo_Robot | 3:8d5a9e3cd680 | 17 | extern Serial pc; |
Yo_Robot | 7:d9aca501126f | 18 | extern DigitalOut pin_son; // SON |
Yo_Robot | 7:d9aca501126f | 19 | extern DigitalOut pin_dir; // SIGN+ |
Yo_Robot | 7:d9aca501126f | 20 | extern InterruptIn pin_alm; // ALM |
Yo_Robot | 7:d9aca501126f | 21 | extern AnalogOut aout; // +-10V |
Yo_Robot | 6:b4dae934e1ea | 22 | |
Yo_Robot | 3:8d5a9e3cd680 | 23 | |
Yo_Robot | 3:8d5a9e3cd680 | 24 | |
Yo_Robot | 4:552beeda4722 | 25 | void setTimer2() |
Yo_Robot | 3:8d5a9e3cd680 | 26 | { |
Yo_Robot | 3:8d5a9e3cd680 | 27 | // Encender Timer2 (PCONP[22]) |
Yo_Robot | 3:8d5a9e3cd680 | 28 | LPC_SC->PCONP |= 1 << 22; |
Yo_Robot | 3:8d5a9e3cd680 | 29 | |
Yo_Robot | 3:8d5a9e3cd680 | 30 | // Resetear y parar el Timer |
Yo_Robot | 3:8d5a9e3cd680 | 31 | LPC_TIM2->TCR = 0x2; |
Yo_Robot | 3:8d5a9e3cd680 | 32 | LPC_TIM2->CTCR = 0x0; |
Yo_Robot | 3:8d5a9e3cd680 | 33 | |
Yo_Robot | 4:552beeda4722 | 34 | // Establecer el Preescaler en cero |
Yo_Robot | 4:552beeda4722 | 35 | // SIn Preesclaer |
Yo_Robot | 4:552beeda4722 | 36 | LPC_TIM2->PR = 0; |
Yo_Robot | 3:8d5a9e3cd680 | 37 | |
Yo_Robot | 4:552beeda4722 | 38 | // Calcular el periodo Inicial |
Yo_Robot | 4:552beeda4722 | 39 | uint32_t periodo = ( SystemCoreClock / 400 ); |
Yo_Robot | 3:8d5a9e3cd680 | 40 | |
Yo_Robot | 3:8d5a9e3cd680 | 41 | // Establecer los Registros de Coincidencia |
Yo_Robot | 3:8d5a9e3cd680 | 42 | // ( Match Register ) |
Yo_Robot | 3:8d5a9e3cd680 | 43 | LPC_TIM2->MR2 = periodo; |
Yo_Robot | 4:552beeda4722 | 44 | LPC_TIM2->MR3 = periodo; // Legacy, salidas identicas |
Yo_Robot | 3:8d5a9e3cd680 | 45 | |
Yo_Robot | 4:552beeda4722 | 46 | LPC_TIM2->MCR |= 1 << 7; // Resetear Timer en MR2 |
Yo_Robot | 3:8d5a9e3cd680 | 47 | |
Yo_Robot | 3:8d5a9e3cd680 | 48 | LPC_TIM2->EMR |= 15UL << 8; // Alternar Pin MAT2.2 |
Yo_Robot | 3:8d5a9e3cd680 | 49 | // y MAT2.3 |
Yo_Robot | 3:8d5a9e3cd680 | 50 | |
Yo_Robot | 3:8d5a9e3cd680 | 51 | LPC_PINCON->PINSEL0 |= 15UL << 16; //Activar MAT2.2 |
Yo_Robot | 6:b4dae934e1ea | 52 | // y MAT2.3 como salidas |
Yo_Robot | 6:b4dae934e1ea | 53 | } |
Yo_Robot | 6:b4dae934e1ea | 54 | |
Yo_Robot | 6:b4dae934e1ea | 55 | |
Yo_Robot | 6:b4dae934e1ea | 56 | void ISR_Serial() |
Yo_Robot | 6:b4dae934e1ea | 57 | { |
Yo_Robot | 7:d9aca501126f | 58 | int value; // Nuevo Valor |
Yo_Robot | 7:d9aca501126f | 59 | char command; // Comando al que aplicar el nuevo valor |
Yo_Robot | 6:b4dae934e1ea | 60 | |
Yo_Robot | 7:d9aca501126f | 61 | pc.scanf( "%d-%c", &value, &command ) ; |
Yo_Robot | 7:d9aca501126f | 62 | pc.printf("\n %d-%c \n", value, command ); |
Yo_Robot | 6:b4dae934e1ea | 63 | |
Yo_Robot | 6:b4dae934e1ea | 64 | // Establecer nueva frecuencia |
Yo_Robot | 7:d9aca501126f | 65 | if( command == 'H') |
Yo_Robot | 7:d9aca501126f | 66 | setPTO( value ); |
Yo_Robot | 7:d9aca501126f | 67 | |
Yo_Robot | 7:d9aca501126f | 68 | else if( command == 'K' ) |
Yo_Robot | 7:d9aca501126f | 69 | setPTO( value * 1000 ); |
Yo_Robot | 7:d9aca501126f | 70 | |
Yo_Robot | 7:d9aca501126f | 71 | // Nuevo voltaje de salida |
Yo_Robot | 7:d9aca501126f | 72 | // Alguna formula para calcular el Vout necesario |
Yo_Robot | 7:d9aca501126f | 73 | // -100% a +100% |
Yo_Robot | 7:d9aca501126f | 74 | else if( command == 'A') |
Yo_Robot | 10:0ebc4955cbe7 | 75 | aout = (float)( value + 100.0 ) / 200.0; |
Yo_Robot | 7:d9aca501126f | 76 | |
Yo_Robot | 7:d9aca501126f | 77 | |
Yo_Robot | 7:d9aca501126f | 78 | // Cambiar la direccion |
Yo_Robot | 7:d9aca501126f | 79 | else if( command == 'D') |
Yo_Robot | 7:d9aca501126f | 80 | pin_dir = value; |
Yo_Robot | 7:d9aca501126f | 81 | |
Yo_Robot | 7:d9aca501126f | 82 | |
Yo_Robot | 7:d9aca501126f | 83 | //Encender el Servo |
Yo_Robot | 7:d9aca501126f | 84 | else if( command == 'S') |
Yo_Robot | 7:d9aca501126f | 85 | pin_son = value; |
Yo_Robot | 7:d9aca501126f | 86 | |
Yo_Robot | 7:d9aca501126f | 87 | //else if( command == 'E') |
Yo_Robot | 7:d9aca501126f | 88 | // setDir( value ); |
Yo_Robot | 6:b4dae934e1ea | 89 | |
Yo_Robot | 7:d9aca501126f | 90 | } |
Yo_Robot | 7:d9aca501126f | 91 | |
Yo_Robot | 7:d9aca501126f | 92 | |
Yo_Robot | 7:d9aca501126f | 93 | void setPTO( int freq ) |
Yo_Robot | 7:d9aca501126f | 94 | { |
Yo_Robot | 7:d9aca501126f | 95 | if( freq != 0 ) |
Yo_Robot | 7:d9aca501126f | 96 | { |
Yo_Robot | 7:d9aca501126f | 97 | LPC_TIM2->TC = 0x00; //Resetear Timer |
Yo_Robot | 7:d9aca501126f | 98 | setMR2( getMRvalue( freq ) ); |
Yo_Robot | 7:d9aca501126f | 99 | startTimer2(); |
Yo_Robot | 7:d9aca501126f | 100 | |
Yo_Robot | 7:d9aca501126f | 101 | }else{ |
Yo_Robot | 6:b4dae934e1ea | 102 | |
Yo_Robot | 7:d9aca501126f | 103 | stopTimer2(); |
Yo_Robot | 7:d9aca501126f | 104 | LPC_TIM2->TC = 0x00; //Resetear Timer |
Yo_Robot | 7:d9aca501126f | 105 | } |
Yo_Robot | 7:d9aca501126f | 106 | } |
Yo_Robot | 7:d9aca501126f | 107 | |
Yo_Robot | 7:d9aca501126f | 108 | void ISR_Alarm() |
Yo_Robot | 7:d9aca501126f | 109 | { |
Yo_Robot | 7:d9aca501126f | 110 | pin_son = 0 ; |
Yo_Robot | 7:d9aca501126f | 111 | stopTimer2(); |
Yo_Robot | 7:d9aca501126f | 112 | aout = 0.5 ; |
Yo_Robot | 7:d9aca501126f | 113 | |
Yo_Robot | 7:d9aca501126f | 114 | pc.printf( "\n\n ERROR: ALARMA \n\n " ); |
Yo_Robot | 7:d9aca501126f | 115 | |
Yo_Robot | 6:b4dae934e1ea | 116 | } |
Yo_Robot | 6:b4dae934e1ea | 117 | |
Yo_Robot | 4:552beeda4722 | 118 | int getMRvalue( int fout ) |
Yo_Robot | 3:8d5a9e3cd680 | 119 | { |
Yo_Robot | 4:552beeda4722 | 120 | float exact, error; |
Yo_Robot | 4:552beeda4722 | 121 | int toRegister; |
Yo_Robot | 4:552beeda4722 | 122 | |
Yo_Robot | 4:552beeda4722 | 123 | exact = (24000000 /(fout*2) ) -1; |
Yo_Robot | 4:552beeda4722 | 124 | toRegister = exact; // Valor redondeado; |
Yo_Robot | 7:d9aca501126f | 125 | //error = exact - toRegister; |
Yo_Robot | 4:552beeda4722 | 126 | |
Yo_Robot | 7:d9aca501126f | 127 | //pc.printf( "\n\n MR value: %d\n error: %f\n" ,toRegister ,error ); |
Yo_Robot | 4:552beeda4722 | 128 | |
Yo_Robot | 4:552beeda4722 | 129 | return toRegister; |
Yo_Robot | 3:8d5a9e3cd680 | 130 | } |
Yo_Robot | 3:8d5a9e3cd680 | 131 | |
Yo_Robot | 3:8d5a9e3cd680 | 132 | |
Yo_Robot | 3:8d5a9e3cd680 | 133 | void setMR2( int newValue ) |
Yo_Robot | 3:8d5a9e3cd680 | 134 | { |
Yo_Robot | 4:552beeda4722 | 135 | LPC_TIM2->MR2 = newValue; // Las dos salidas son identicas |
Yo_Robot | 4:552beeda4722 | 136 | LPC_TIM2->MR3 = newValue; // Para testear el programa. |
Yo_Robot | 3:8d5a9e3cd680 | 137 | } |
Yo_Robot | 3:8d5a9e3cd680 | 138 | |
Yo_Robot | 3:8d5a9e3cd680 | 139 | |
Yo_Robot | 3:8d5a9e3cd680 | 140 | |
Yo_Robot | 3:8d5a9e3cd680 | 141 | void startTimer2() |
Yo_Robot | 3:8d5a9e3cd680 | 142 | { |
Yo_Robot | 7:d9aca501126f | 143 | // Arrancar el Timer 2 |
Yo_Robot | 3:8d5a9e3cd680 | 144 | LPC_TIM2->TCR = 1; |
Yo_Robot | 3:8d5a9e3cd680 | 145 | } |
Yo_Robot | 3:8d5a9e3cd680 | 146 | |
Yo_Robot | 3:8d5a9e3cd680 | 147 | void stopTimer2() |
Yo_Robot | 3:8d5a9e3cd680 | 148 | { |
Yo_Robot | 4:552beeda4722 | 149 | // Detener el Timer 2 |
Yo_Robot | 3:8d5a9e3cd680 | 150 | LPC_TIM2->TCR = 0x2; |
Yo_Robot | 4:552beeda4722 | 151 | } |
Yo_Robot | 4:552beeda4722 | 152 | |
Yo_Robot | 6:b4dae934e1ea | 153 | |
Yo_Robot | 6:b4dae934e1ea | 154 | |
Yo_Robot | 6:b4dae934e1ea | 155 | |
Yo_Robot | 6:b4dae934e1ea | 156 | |
Yo_Robot | 4:552beeda4722 | 157 | /* LEGACY FUNCTIONS |
Yo_Robot | 4:552beeda4722 | 158 | * |
Yo_Robot | 5:c5aea1eb10bb | 159 | * El codigo actual no hace referencia a estas funciones |
Yo_Robot | 5:c5aea1eb10bb | 160 | * sin embargo no hay problema en definirlas. |
Yo_Robot | 4:552beeda4722 | 161 | */ |
Yo_Robot | 4:552beeda4722 | 162 | void setMR3( int newValue ) |
Yo_Robot | 4:552beeda4722 | 163 | { |
Yo_Robot | 4:552beeda4722 | 164 | LPC_TIM2->MR3 = newValue; |
Yo_Robot | 4:552beeda4722 | 165 | } |
Yo_Robot | 4:552beeda4722 | 166 | |
Yo_Robot | 4:552beeda4722 | 167 | |
Yo_Robot | 4:552beeda4722 | 168 | void setPrescaler( int newValue) |
Yo_Robot | 4:552beeda4722 | 169 | { |
Yo_Robot | 4:552beeda4722 | 170 | LPC_TIM2->PR = newValue; |
Yo_Robot | 4:552beeda4722 | 171 | } |