365 lines
8.6 KiB
C++
365 lines
8.6 KiB
C++
|
//NOTA OJOJOJOJOJOJOJO CUIDADO \u00aa!!!!!!!!!!!
|
||
|
|
// EL VALOR DE UMBRAL CAMBIA
|
||
|
|
|
||
|
|
//SETTUP PARA CADA PLACA
|
||
|
|
#include "WProgram.h"
|
||
|
|
void setup();
|
||
|
|
void loop();
|
||
|
|
void readSensor();
|
||
|
|
void Xbeetx(int id, int dat);
|
||
|
|
void SendXbee();
|
||
|
|
void readByte();
|
||
|
|
void sendUp();
|
||
|
|
void simplificamosRFID();
|
||
|
|
void actualizamosRFID();
|
||
|
|
void blink(int thisPin, int howManyTimes);
|
||
|
|
void playTone();
|
||
|
|
void pitidoPositivo();
|
||
|
|
void pitidoParada();
|
||
|
|
void pitidoNegativo();
|
||
|
|
int boarNumber = 17; //Board Number change this value for each board
|
||
|
|
int umbral = 20; //VER NOTA ARRIBA, SI ES ACELEROMETRO UMBRAL = 20 /cajas 17,18,19 y 20 = 40
|
||
|
|
boolean dosSensores = true; //depende del tipo de placa 1 o 2 sensores analogicos
|
||
|
|
#define dataRate 9600 // for RFID reader
|
||
|
|
// TONES ==========================================
|
||
|
|
// Start by defining the relationship between
|
||
|
|
// note, period, & frequency.
|
||
|
|
#define c 3830 // 261 Hz
|
||
|
|
#define d 3400 // 294 Hz
|
||
|
|
#define e 3038 // 329 Hz
|
||
|
|
#define f 2864 // 349 Hz
|
||
|
|
#define g 2550 // 392 Hz
|
||
|
|
#define a 2272 // 440 Hz
|
||
|
|
#define b 2028 // 493 Hz
|
||
|
|
#define C 1912 // 523 Hz
|
||
|
|
// Define a special note, 'R', to represent a rest
|
||
|
|
#define R 0
|
||
|
|
|
||
|
|
// SETUP ============================================
|
||
|
|
// Set up speaker on a PWM pin (digital 9, 10 or 11)
|
||
|
|
int speakerOut = 9;
|
||
|
|
|
||
|
|
// MELODY and TIMING =======================================
|
||
|
|
// melody[] is an array of notes, accompanied by beats[],
|
||
|
|
// which sets each note's relative length (higher #, longer note)
|
||
|
|
int melodyStart[] = { C, b, g, C, R};
|
||
|
|
int beatsStart[] = { 16, 16, 16, 8, 32};
|
||
|
|
|
||
|
|
int melodyStop[] = { b, e};
|
||
|
|
int beatsStop[] = { 8, 16};
|
||
|
|
|
||
|
|
int melodyNo[] = { c };
|
||
|
|
int beatsNo[] = { 32};
|
||
|
|
|
||
|
|
int MAX_COUNT1 = sizeof(melodyStart)/2; // Melody length, for looping.
|
||
|
|
int MAX_COUNT2 = sizeof(melodyStop)/2; // Melody length, for looping.
|
||
|
|
int MAX_COUNT3 = sizeof(melodyNo)/2; // Melody length, for looping.
|
||
|
|
|
||
|
|
// Set overall tempo
|
||
|
|
long tempo = 10000;
|
||
|
|
// Set length of pause between notes
|
||
|
|
int pause = 1000;
|
||
|
|
// Loop variable to increase Rest length
|
||
|
|
int rest_count = 100; //<-BLETCHEROUS HACK; See NOTES
|
||
|
|
|
||
|
|
// Initialize core variables
|
||
|
|
int tone = 0;
|
||
|
|
int beat = 0;
|
||
|
|
long duration = 0;
|
||
|
|
|
||
|
|
//THE TAG-RFID READER
|
||
|
|
char code[10]; // var that will hold the bytes-in read from the serialBuffer
|
||
|
|
char oldCode[10]; //para guardar la ultimo TAG-RFID y poder compara con el nuevo
|
||
|
|
char miniCode[4]; //var para enviar solo los ultimos 4 digitos del codigo del RFID
|
||
|
|
int val = 0; //variable para guardar codigos temporal
|
||
|
|
int valX = 0;
|
||
|
|
int valY = 0;
|
||
|
|
int valZ = 0;
|
||
|
|
int valInfrarred = 0;
|
||
|
|
int diff = 0;
|
||
|
|
int bytesread = 0; //variable para guardar el numero de decimales leidos del RFID
|
||
|
|
|
||
|
|
long time1;
|
||
|
|
long timeOld1;
|
||
|
|
long difTime1 = 0;
|
||
|
|
long difTimeUmbral1 = 5000; //envia que el sensor esta activo cada 5 segudos
|
||
|
|
|
||
|
|
////////////////////////////////////////////////////////////////////
|
||
|
|
|
||
|
|
int lowbat = 13; // Pin de bateria baja
|
||
|
|
int nivel = 3; //Sensor de nivel de bateria
|
||
|
|
int xbee = 4; //Pin de activacion del xbee
|
||
|
|
int buzzer = 9;
|
||
|
|
|
||
|
|
int i=0;
|
||
|
|
int rfid_ok=0;
|
||
|
|
int id=0;
|
||
|
|
int ini=20;
|
||
|
|
int env=3;
|
||
|
|
|
||
|
|
void setup()
|
||
|
|
{
|
||
|
|
|
||
|
|
digitalWrite(xbee, HIGH); //Habilito XBEE
|
||
|
|
//encendemos el led
|
||
|
|
pinMode(speakerOut, OUTPUT);
|
||
|
|
|
||
|
|
Serial.begin(9600);
|
||
|
|
pinMode(lowbat, OUTPUT);
|
||
|
|
pinMode(xbee, OUTPUT);
|
||
|
|
|
||
|
|
for (i = 5; i < 9; i++) pinMode(i, INPUT);
|
||
|
|
for (i = 5; i < 9; i++)
|
||
|
|
{
|
||
|
|
if (digitalRead(i))
|
||
|
|
{
|
||
|
|
if (i==5) val=1;
|
||
|
|
else if (i==6) val=2;
|
||
|
|
else if (i==7) val=4;
|
||
|
|
else if (i==8) val=8;
|
||
|
|
id=id+val;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
id = 21;//en n futuro cogerlo de los pines
|
||
|
|
|
||
|
|
blink(13,3); // blink an LED:
|
||
|
|
|
||
|
|
//pitido positivo
|
||
|
|
pitidoPositivo();
|
||
|
|
|
||
|
|
//inicializamos miniCode a 0
|
||
|
|
for (int i = 0; i<3; i++) {
|
||
|
|
miniCode[i]='0';
|
||
|
|
}
|
||
|
|
miniCode[3]=0;
|
||
|
|
|
||
|
|
//inicializamos code a 0
|
||
|
|
for (int i = 0; i<9; i++) {
|
||
|
|
code[i]='0';
|
||
|
|
oldCode[i] = '0';
|
||
|
|
}
|
||
|
|
code[9]=0;
|
||
|
|
oldCode[9]=0;
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void loop()
|
||
|
|
{
|
||
|
|
readByte();
|
||
|
|
|
||
|
|
readSensor();
|
||
|
|
|
||
|
|
sendUp();
|
||
|
|
|
||
|
|
delay(100);
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
void readSensor(){
|
||
|
|
|
||
|
|
valX=analogRead(0); //tres ejes acelerometro
|
||
|
|
valY=analogRead(1); //tres ejes acelerometro
|
||
|
|
valZ=analogRead(2); //tres ejes acelerometro
|
||
|
|
valInfrarred=analogRead(4); //infrarrojo
|
||
|
|
|
||
|
|
//difX = abs(valXold - valX);
|
||
|
|
//difY = abs(valYold - valY);
|
||
|
|
//difZ = abs(valZold - valZ);
|
||
|
|
//difInfrarred = abs(valInfrarrdOld - valInfrarred);
|
||
|
|
|
||
|
|
SendXbee();
|
||
|
|
}
|
||
|
|
|
||
|
|
void Xbeetx(int id, int dat){
|
||
|
|
Serial.print((id<<4)||(dat>>4),BYTE);
|
||
|
|
Serial.print((id<<4)||(0x0F&dat),BYTE);
|
||
|
|
}
|
||
|
|
|
||
|
|
void SendXbee(){
|
||
|
|
Serial.print(id,DEC); //id
|
||
|
|
delay(env);
|
||
|
|
Serial.print(":");
|
||
|
|
delay(env);
|
||
|
|
Serial.print(miniCode);
|
||
|
|
delay(env);
|
||
|
|
Serial.print(":");
|
||
|
|
delay(env);
|
||
|
|
|
||
|
|
Serial.print(map(valX, 0, 675, 0, 255),DEC);
|
||
|
|
delay(env);
|
||
|
|
Serial.print(":");
|
||
|
|
delay(env);
|
||
|
|
Serial.print(map(valY, 0, 675, 0, 255),DEC);
|
||
|
|
delay(env);
|
||
|
|
Serial.print(":");
|
||
|
|
delay(env);
|
||
|
|
Serial.print(map(valZ, 0, 675, 0, 255),DEC);
|
||
|
|
delay(env);
|
||
|
|
Serial.print(":");
|
||
|
|
delay(env);
|
||
|
|
|
||
|
|
Serial.println(map(valInfrarred, 0, 675, 0, 255),DEC);
|
||
|
|
delay(env);
|
||
|
|
}
|
||
|
|
|
||
|
|
void readByte(){
|
||
|
|
bytesread=0;
|
||
|
|
|
||
|
|
while (Serial.available()>0)
|
||
|
|
{
|
||
|
|
val=Serial.read(); //RFID
|
||
|
|
code[bytesread] = val;
|
||
|
|
bytesread++;
|
||
|
|
|
||
|
|
if(bytesread == 10){
|
||
|
|
//comparamos si el nuevo codigo es igual al anterior (se lee el mismo tag dos veces)
|
||
|
|
if (memcmp(code,oldCode, 10) == 0){ //si son iguales
|
||
|
|
pitidoNegativo();
|
||
|
|
}else{ //SI SON DISTINTOS (el nuevo codigo es diferente)
|
||
|
|
actualizamosRFID();
|
||
|
|
simplificamosRFID();
|
||
|
|
pitidoPositivo();
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void sendUp(){
|
||
|
|
|
||
|
|
time1 = millis(); //record the actual time
|
||
|
|
difTime1 = abs(time1 - timeOld1); //calculate de diference time from last reading
|
||
|
|
|
||
|
|
if (difTime1 > difTimeUmbral1){
|
||
|
|
val=analogRead(nivel); //bateria
|
||
|
|
if (val<=614) digitalWrite(lowbat, LOW); //Umbral de bateria baja 3v, que equivale a 614
|
||
|
|
else digitalWrite(lowbat, HIGH);
|
||
|
|
|
||
|
|
Serial.print(boarNumber, DEC);
|
||
|
|
delay(env);
|
||
|
|
Serial.print(":c:");
|
||
|
|
delay(env);
|
||
|
|
Serial.print(map(val, 0, 860, 0, 810),DEC); //El maximo de tension de la bateria son 4'2v, que equivale a 860
|
||
|
|
delay(env);
|
||
|
|
timeOld1 = time1;
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
void simplificamosRFID() { //simplificamos el codigo del RFID a los 4 ultimos valores
|
||
|
|
|
||
|
|
for (int i = 0; i<3; i++) { //guardamos el valor corto del RFID
|
||
|
|
miniCode[i]=code[7+i];
|
||
|
|
}
|
||
|
|
miniCode[3]=0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void actualizamosRFID() {
|
||
|
|
|
||
|
|
for (int i = 0; i < 10; i++){ //guardamos el valor del RFID en memoria
|
||
|
|
oldCode[i] = code[i];
|
||
|
|
}
|
||
|
|
|
||
|
|
for (int i = 0; i<3; i++) { //guardamos el valor corto del RFID
|
||
|
|
miniCode[i]=oldCode[7+i];
|
||
|
|
}
|
||
|
|
miniCode[3]=0;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
/*
|
||
|
|
blink method blinks an LED a given number of times
|
||
|
|
*/
|
||
|
|
void blink(int thisPin, int howManyTimes) {
|
||
|
|
// set the LED's pin as an output:
|
||
|
|
pinMode(thisPin, OUTPUT);
|
||
|
|
// blink the LED:
|
||
|
|
for (int t = 0; t < howManyTimes; t++) {
|
||
|
|
digitalWrite(thisPin, HIGH);
|
||
|
|
delay(200);
|
||
|
|
digitalWrite(thisPin, LOW);
|
||
|
|
delay(200);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// PLAY TONE ==============================================
|
||
|
|
// Pulse the speaker to play a tone for a particular duration
|
||
|
|
void playTone() {
|
||
|
|
long elapsed_time = 0;
|
||
|
|
if (tone > 0) { // if this isn't a Rest beat, while the tone has
|
||
|
|
// played less long than 'duration', pulse speaker HIGH and LOW
|
||
|
|
while (elapsed_time < duration) {
|
||
|
|
|
||
|
|
digitalWrite(speakerOut,HIGH);
|
||
|
|
delayMicroseconds(tone / 2);
|
||
|
|
|
||
|
|
// DOWN
|
||
|
|
digitalWrite(speakerOut, LOW);
|
||
|
|
delayMicroseconds(tone / 2);
|
||
|
|
|
||
|
|
// Keep track of how long we pulsed
|
||
|
|
elapsed_time += (tone);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
else { // Rest beat; loop times delay
|
||
|
|
for (int j = 0; j < rest_count; j++) { // See NOTE on rest_count
|
||
|
|
delayMicroseconds(duration);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
void pitidoPositivo() {
|
||
|
|
|
||
|
|
for (int i=0; i<MAX_COUNT1; i++) {
|
||
|
|
tone = melodyStart[i];
|
||
|
|
beat = beatsStart[i];
|
||
|
|
|
||
|
|
duration = beat * tempo; // Set up timing
|
||
|
|
playTone();
|
||
|
|
// A pause between notes...
|
||
|
|
delayMicroseconds(pause);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void pitidoParada(){
|
||
|
|
|
||
|
|
for (int i=0; i<MAX_COUNT2; i++) {
|
||
|
|
tone = melodyStop[i];
|
||
|
|
beat = beatsStop[i];
|
||
|
|
|
||
|
|
duration = beat * tempo; // Set up timing
|
||
|
|
playTone();
|
||
|
|
// A pause between notes...
|
||
|
|
delayMicroseconds(pause);
|
||
|
|
}
|
||
|
|
|
||
|
|
}
|
||
|
|
|
||
|
|
void pitidoNegativo() {
|
||
|
|
|
||
|
|
for (int i=0; i<MAX_COUNT3; i++) {
|
||
|
|
tone = melodyNo[i];
|
||
|
|
beat = beatsNo[i];
|
||
|
|
|
||
|
|
duration = beat * tempo; // Set up timing
|
||
|
|
playTone();
|
||
|
|
// A pause between notes...
|
||
|
|
delayMicroseconds(pause);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
int main(void)
|
||
|
|
{
|
||
|
|
init();
|
||
|
|
|
||
|
|
setup();
|
||
|
|
|
||
|
|
for (;;)
|
||
|
|
loop();
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|