Einer Fabian Aponte Cubides / Mbed 2 deprecated Primeraentrega

Dependencies:   mbed

main.cpp

Committer:
Darstack
Date:
2019-03-09
Revision:
3:3454cb7584e1
Parent:
2:d168f964c331

File content as of revision 3:3454cb7584e1:

#include "mbed.h"
#include "scolor_TCS3200.h"

/* *****************************************************************************
Programa que solicita telemetria al sistema embebido, por medio del comando  0xFe
para preguntar por el color  que detecta el sensor TCS3200

el sistema embebido recibe  el inicio de trama FE  y el número de comado: 01
   
|   INITELE  |  CMD       |   
|     0xfe   | 0x01       | 


para enviar los comandos usar el programa Coolterm http://freeware.the-meiers.org/


@fabeltranm 2019
fbeltranm@ecci.edu.co

********************************************************************************
   datasheet https://www.mouser.com/catalog/specsheets/TCS3200-E11.pdf


    S0      Frequency scaling 
    S1      Frequency scaling 
    S2      Photo diode selection 
    S3      Photo diode selection 
    OutFreq Frequency

       -----------------------------------
      |   ____________     ____________   |
----> |  |            |   |            |  |                ___     ___ 
Light |  | Photodiode |   |   Current  |--|---OUTPUT_FREQ |   |___|   |___
----> |  |   Array    |---|     to     |  |
      |  |            |   |  Frequency |  |
      |  |____________|   |____________|  |
      |       ^  ^             ^  ^       |
       -------|--|-------------|--|-------
              |  |             |  |
             S2 S3            S0  S1
             
SO | S1 | OUTPUT FREQUENCY SCALING |        | S2 | S3 |   PHOTODIODE TYPE   |
 0 | 0  |        power down        |        |  0 | 0  |         Red         |
 0 | 1  |           2%             |        |  0 | 1  |         Blue        |
 1 | 0  |           20%            |        |  1 | 0  |  Clear (no filter)  |
 1 | 1  |           100%           |        |  1 | 1  |         Green       | 
             
******************************************************************************/

#define INITELE 0xFE
#define RESPUESTA1 0xFF01
#define RESPUESTA2 0xFF02
#define RESPUESTA3 0xFF03
#define RESPUESTA4 0xFF04
#define RESPUESTA5 0xFF05
#define CMD  0x01
#define DO  1300
#define RE  1500 
#define MI  1600
#define FA  1800
#define SO  2000 


Serial command(USBTX, USBRX);
//                     S0,    S1,   S2,   S3,    OUT
scolor_TCS3200 scolor(PA_8, PB_10, PB_4, PB_5, PB_3);

// definición de las funciones
void setup_uart();
void leer_datos();
void leer_color();
uint8_t cmd;
PwmOut mybuzzer(PA_5);

int main() {

    setup_uart();
    while(1){    
        leer_datos();
        if (cmd==CMD){}
            leer_color();
    }    
}



void setup_uart(){
    command.baud(115200);
}


void leer_datos(){
    while(command.getc()!= INITELE);
    cmd=command.getc();   
}


void leer_color(){
    
    mybuzzer.write(0);
    long     red = scolor.ReadRed();
    long     green = scolor.ReadGreen();
    long     blue = scolor.ReadBlue();
    long     clear = scolor.ReadClear();
    
    long frqred;
    long frqgreen;
    long frqblue;
    long frqclear;
    int8_t sel_color;
    printf("RED: %5d     GREEN: %5d     BLUE: %5d     CLEAR: %5d    \n ", red, green, blue, clear);
    
    frqred = ( ( 1.0/red )* 1000.0 );
    frqgreen = ( ( 1.0/green ) * 1000.0);
    frqblue = ( (1.0/blue) *1000.0 );
    frqclear = ( (1.0/clear) *1000.0 );
    printf("RED: %5d     GREEN: %5d     BLUE: %5d     CLEAR: %5d    \n ", frqred, frqgreen, frqblue,frqclear);
 ///////////////////////////////////////////////////////////////////////////////
 /*||||||||||||||||Seleccionando los diferentes colores.||||||||||||||||||||||*/
 /*||||||||||||||||||||||||||||||Color rojo|||||||||||||||||||||||||||||||||||*/
 /////////////////////////////////////////////////////////////////////////////// 
    if ( frqred >= 30.0 and frqred <= 500.0) {
        
        if( frqgreen >= 0.0 and frqgreen <= 20.0 ) {
            
            if ( frqblue >= 5.0 and frqblue <= 29.0 ) {  
                
                //printf ( "tiende a rojo \n" );
                mybuzzer.period_us(DO);
                mybuzzer.write(0.5);
                wait(5);
                mybuzzer.write(0);
                sel_color=1;
                
            }
        }
    }
////////////////////////////////////////////////////////////////////////////////
/*°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°Color verde°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°*/
////////////////////////////////////////////////////////////////////////////////      
    if ( frqgreen >= 11.0 and frqgreen <= 21.0) {

        if( frqred >= 8.0 and frqred <= 20.0 ) {

            if ( frqblue >= 10.0 and frqblue <= 22.0 ) { 
            
            printf ( "tiende a verde  \n" );
            mybuzzer.period_us(RE);
            mybuzzer.write(0.5);
            wait(5);
            mybuzzer.write(0);
            sel_color=2;
            
            }
        }
    }
////////////////////////////////////////////////////////////////////////////////
/*°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°Color azul°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°*/
 ///////////////////////////////////////////////////////////////////////////////       
    if ( frqblue >= 10.0 and frqblue <= 70.0) {
    
        if( frqgreen >= 5.0 and frqgreen <= 26.0 ) {
            
            if ( frqred >= 5.0 and frqred <= 25.0 ) { 
            
            //printf ( "tiende a azul \n" );
            mybuzzer.period_us(MI);
            mybuzzer.write(0.5);
            wait(5);
            mybuzzer.write(0);
            sel_color=3;
            
            }
        }
    }
/////////////////////////////////////////////////////////////////////////////////
/*°°°°°°°°°°°°°°°°°°°°°°°°°°°°°Color amarillo°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°*/
 ////////////////////////////////////////////////////////////////////////////////
    if ( frqblue >= 0.0 and frqblue <= 25.0 ) {
        
        if( frqgreen >= 20.0 and frqgreen <= 40.0) {
            
            if ( 20.0 >= frqred <= 46.0 ) {
                
            printf ( "tiende a amarillo \n" );    
            mybuzzer.period_us(FA);
            mybuzzer.write(0.5);
            wait(5);
            mybuzzer.write(0);    
            sel_color=4;
                        
            }
        }
    }
/////////////////////////////////////////////////////////////////////////////////
/*°°°°°°°°°°°°°°°°°°°°°°°°°°°°°Color no found°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°°*/
 ////////////////////////////////////////////////////////////////////////////////
 
 switch ( sel_color ) {
    
    case 1:
    
    int32_t enviar = RESPUESTA1 ;
    char txt [6] ;
    printf ( txt, "%04X" , RESPUESTA1 );
    
    break;
    
    case 2:
    
    int32_t enviar = RESPUESTA2 ;
    char txt [6] ;
    printf ( txt, "%04X" , RESPUESTA2 ) ;
    
    break;
    
    case 3:
    
    int32_t enviar = RESPUESTA3;
    char txt [6] ;
    printf ( txt, "%04X" , RESPUESTA3 );
    
    break;
    
    case 4:
    
    int32_t enviar = RESPUESTA4;
    char txt [6] ;
    printf ( txt, "%04X" , RESPUESTA4 );
    break; 
    
    default:{
        
    int32_t enviar = RESPUESTA4;
    char txt [6] ;
    printf ( txt, "%04X" , RESPUESTA4 ); 
       
    }
 

}

}