forked from IFRN-SC/robo_hardware
-
Notifications
You must be signed in to change notification settings - Fork 0
/
CorTcs34.cpp
53 lines (35 loc) · 1.37 KB
/
CorTcs34.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
#include "CorTcs34.h"
#define NUM_MAX_SENSORES_COR 10
Adafruit_TCS34725 CorTcs34::tcsCorHardware = Adafruit_TCS34725(TCS34725_INTEGRATIONTIME_50MS, TCS34725_GAIN_4X);
int CorTcs34::pinosLigaDesliga[NUM_MAX_SENSORES_COR];
int CorTcs34::numPinos=0;
CorTcs34::CorTcs34(int pino){
pinoLiga = pino;
if(numPinos<NUM_MAX_SENSORES_COR){
pinosLigaDesliga[numPinos] = pino;
numPinos++;
}
}
void CorTcs34::config(){
pinMode(pinoLiga, OUTPUT);
}
void CorTcs34::desligaTodosSensores(){
for(int i=0; i<numPinos; i++){
digitalWrite(pinosLigaDesliga[i], LOW);
}
}
void CorTcs34::ligarSensor(){ // Função que liga o sensor1 e desliga e deliga os outros sensores
desligaTodosSensores();
digitalWrite(pinoLiga, HIGH); //Liga o sensor
delay(4); // Delay para pode inicializar o sensor (se diminuido ou retirado, o sensor não conseguira inicializar).
tcsCorHardware.begin(); // Método "begin" (começo) da classe do Adafruit. Inicializa o sensor.
}
void CorTcs34::atualizarRGB(){
uint16_t clear, red, green, blue; // Variáveis de leitura para a classe da Adafruit.
ligarSensor();
delay(60);
tcsCorHardware.getRawData(&red, &green, &blue, &clear); // Método da classe Adafruit que lê os dados "brutos" do sensor.
rgb.vermelho = red; //
rgb.verde = green; //
rgb.azul = blue; // Coloca os valores lidos em sua respectivas variáveis da struct RGB
}