Primera Prueba
Dependencies: FastAnalogIn HSI2RGBW_PWM NVIC_set_all_priorities mbed-dsp mbed
Fork of Seniales-Final by
Diff: main.cpp
- Revision:
- 4:214f7d72f740
- Parent:
- 3:6c9dabbb7261
diff -r 6c9dabbb7261 -r 214f7d72f740 main.cpp --- a/main.cpp Sun May 03 22:53:37 2015 +0000 +++ b/main.cpp Wed Nov 25 21:28:57 2015 +0000 @@ -5,18 +5,6 @@ #include "arm_const_structs.h" #include "FastAnalogIn.h" //Librería modificada basada en la función de AnalogIn que reduce el tiempo de procesamiento de las señales ADC -//**********Declaraciones devariables para la silla**************** - -DigitalOut EnableLeft(PTC9);//Salida que habilitara o deshabilitara el puente H de la llanta izquierda -DigitalOut EnableRight(PTC8);//Salida que habilitara o deshabilitara el puente H de la llanta derecha - -DigitalOut RightControl1(PTA5);//Salidas que controlan los estados del puente H de la llanta derecha -DigitalOut RightControl2(PTA4); - -DigitalOut LeftControl1(PTA12);//Salidas que controlan los estados del puente H de la llanta izquierda -DigitalOut LeftControl2(PTD4); -//******************************************************* - Serial pc(USBTX, USBRX); //Se declaran los pines que se utilizarán para la comunicación serial mediante USB para debuggeo (PTA1 - RX, PTA2 - TX) FastAnalogIn segnal(PTC2); //Se declara el pin que recibirá la señal análoga del sensor @@ -32,7 +20,6 @@ const int FFT_SIZE = 1024; // Número de valores para la transformada rápida float freq = 40000.0/1024.0; // Frecuencia de activación de la interrupción de muestreo float max[2]; // Arreglo que almacena la frecuencia y magnitud mayores del espectro de Fourier -char blue_freq=0; // Variable que almacena el valor que se envia por bluetooth de los BPM //////////////////////////////////////////////////////////////////////////////// // ESTADO INTERNO @@ -79,42 +66,6 @@ return sampleCounter >= FFT_SIZE*2; } -//************Funciones del funcionamiento de la silla -void Avanzar(void){//Esta funcion tiene las salidas programadas para que la silla avance hace delante - RightControl1=0; - RightControl2=1; - LeftControl1=0; - LeftControl2=1; - EnableLeft=1; - EnableRight=1; - } - -void Retroceder(void){//Esta funcion las salidas programadas para que la silla retroceda - RightControl1=1; - RightControl2=0; - LeftControl1=1; - LeftControl2=0; - EnableLeft=1; - EnableRight=1; - } -void Derecha(void){//Esta funcion tiene las salidas programadas para que la silla avance a la derehca (apaga el motor derecho y enciende el motor izquierdo) - LeftControl1=0; - LeftControl2=1; - EnableLeft=1; - EnableRight=0; - } -void Izquierda(void){//Esta funcion tiene las salidas programadas para que la silla avance a la izquierda (apaga el motor izquierdo y enciende el motor derecho) - RightControl1=0; - RightControl2=1; - EnableLeft=0; - EnableRight=1; - } -void Alto(void){//Esta fucnion apaga los enables del puente H y por lo tanto la silla para - EnableLeft=0; - EnableRight=0; - } -//************************************************ - //////////////////////////////////////////////////////////////////////////////// // MAIN DEL PROGRAMA //////////////////////////////////////////////////////////////////////////////// @@ -169,21 +120,11 @@ pc.printf("\n %f\n", max[0]); pc.printf("\nChifla Jessi\n"); - Derecha(); - wait(1); - Retroceder(); - wait(1); - Alto(); } else if (max[0]<=3500 && max[0]>= 3000){ pc.printf("\n %f\n", max[0]); pc.printf("\nChifla Soto\n"); - Avanzar(); - wait(1); - Izquierda(); - wait(1); - Alto(); } else if (max[0]<=2200 && max[0]>= 2500){