X-Git-Url: http://git.piffa.net/web?a=blobdiff_plain;f=libraries%2Fcommon%2Fcommon.cpp;h=4a886b26cc95186a358d0cd66af4abc5a5c27052;hb=c5a3dc4a9cc7eea224814fee4b00575e726105fa;hp=359896976b81b3a0676fc232d54235dbc215bb1b;hpb=51f324396aad33efa1b0218ffee334a1f7d7c084;p=sketchbook_andrea diff --git a/libraries/common/common.cpp b/libraries/common/common.cpp index 3598969..4a886b2 100644 --- a/libraries/common/common.cpp +++ b/libraries/common/common.cpp @@ -1,94 +1,126 @@ /* Common * * Oggetti di uso comune + * Autore: Andrea Manni + * + * Link: http://git.andreamanni.com/ + * Licenza: GPLv3 */ #include "Arduino.h" #include "common.h" +#define DEBUG_not ////////////////////// // RGB LED // Common anode / cat -RGBLed::RGBLed(byte pinR, byte pinG, byte pinB) { +RGBLed::RGBLed(byte pinR, byte pinG, byte pinB) { // Per un common catodo, valore max / min invertiti - redPin = pinR ; - greenPin = pinG ; - bluePin = pinB ; - common = 0 ; - - // Equvalente del Setup() per inizializzare i PIN - pinMode(redPin, OUTPUT); - pinMode(greenPin, OUTPUT); - pinMode(greenPin, OUTPUT); + redPin = pinR ; + greenPin = pinG ; + bluePin = pinB ; + common = 0 ; + + // Equvalente del Setup() per inizializzare i PIN + pinMode(redPin, OUTPUT); + pinMode(greenPin, OUTPUT); + pinMode(greenPin, OUTPUT); }; RGBLed::RGBLed(byte pinR, byte pinG, byte pinB, byte com) { // Per un common anode, valore max / min normali - redPin = pinR ; - greenPin = pinG ; - bluePin = pinB ; - common = com ; - - // Equvalente del Setup() per inizializzare i PIN - pinMode(redPin, OUTPUT); - pinMode(greenPin, OUTPUT); - pinMode(greenPin, OUTPUT); + redPin = pinR ; + greenPin = pinG ; + bluePin = pinB ; + common = com ; + + // Equvalente del Setup() per inizializzare i PIN + pinMode(redPin, OUTPUT); + pinMode(greenPin, OUTPUT); + pinMode(greenPin, OUTPUT); }; void RGBLed::SetColor (byte r, byte g, byte b) { // Imposta il colore di un LED RGB - analogWrite(redPin, common - r); - analogWrite(greenPin, common - g); - analogWrite(bluePin, common - b); - }; + if (common == 0) { + analogWrite(redPin, r); + analogWrite(greenPin, g); + analogWrite(bluePin, b); + } else { + analogWrite(redPin, 255 - r); + analogWrite(greenPin, 255 - g); + analogWrite(bluePin, 255 - b); + } + + +// Debug +#ifdef DEBUG + Serial.print(r); + Serial.print("-"); + Serial.print(g); + Serial.print("-"); + Serial.print(b); + while(1); +#endif + +}; + +void RGBLed::Rand () { +// Imposta il colore di un LED RGB + analogWrite(redPin, random(0,256)); + analogWrite(greenPin, random(0,256)); + analogWrite(bluePin, random(0,256)); +}; void RGBLed::Red () { // Accende il LED di rosso - SetColor(0,255,255); - }; + SetColor(255,0,0); +}; void RGBLed::Green () { // Accende il LED di verde - SetColor(255,0,255); - }; + SetColor(0,255,0); +}; void RGBLed::Blue () { // Accende il LED di blu - SetColor(255,255,0); - }; + SetColor(0,0,255); +}; void RGBLed::Magenta () { // Accende il LED di magenta - SetColor(0,255,0); - }; + SetColor(255,0,255); +}; void RGBLed::Cyano () { // Accende il LED di Cyano - SetColor(255,0,0); - }; + SetColor(0,255,255); +}; void RGBLed::Yellow () { // Accende il LED di giallo - SetColor(0,0,255); - }; + SetColor(255,255,0); +}; void RGBLed::White () { -// Accende il LED - SetColor(0,0,0); - }; +// Accende il LED + SetColor(255,255,255); +}; void RGBLed::Off () { -// Spegne il LED - SetColor(255,255,255); - }; +// Spegne il LED + SetColor(0,0,0); +}; ///////////////////////////////////// // Lampeggiatore // Constructor +// +// Esempi incrementali: https://lab.piffa.net/sketchbook_andrea/multitasking/ Lampeggiatore::Lampeggiatore(int pin) { ledPin = pin; @@ -107,41 +139,42 @@ void Lampeggiatore::Invert() { void Lampeggiatore::Blink() { // Illumina il led a 500ms - if(millis() - previousMillis > interval) { - // save the last time you blinked the LED - previousMillis = millis(); + if(millis() + shift - previousMillis > interval) { // if the LED is off turn it on and vice-versa: ledState = !ledState ; // Inverti il LED + // set the LED with the ledState of the variable: + digitalWrite(ledPin, ledState); + // save the last time you blinked the LED + previousMillis += interval; } - // set the LED with the ledState of the variable: - digitalWrite(ledPin, ledState); }; -void Lampeggiatore::Blink(long time) { +void Lampeggiatore::Blink(long time, long drift ) { // Illumina il led secondo un intervallo passato come argomento - if(millis() - previousMillis > time) { - // save the last time you blinked the LED - previousMillis = millis(); - + shift = drift; + if(millis() + shift - previousMillis > time) { // if the LED is off turn it on and vice-versa: ledState = !ledState ; // Inverti il LED - } // set the LED with the ledState of the variable: digitalWrite(ledPin, ledState); + // save the last time you blinked the LED + previousMillis += time; + } }; -void Lampeggiatore::Blink(long up, long down) { +void Lampeggiatore::Blink(long up, long down, long drift ) { // Illumina il ledB precisando ontime e downtime - if((ledState == HIGH)&& (millis() - previousMillis > up)) { - // save the last time you blinked the LED - previousMillis = millis(); + shift = drift; + if((ledState == HIGH)&& (millis() + shift - previousMillis > up)) { + // save the last time you blinked the LED + previousMillis += up; ledState = LOW ; } - else if((ledState == LOW)&& (millis() - previousMillis > down)) { - previousMillis = millis(); + else if((ledState == LOW)&& (millis() + shift - previousMillis > down)) { + previousMillis += down; ledState = HIGH ; } @@ -151,29 +184,26 @@ void Lampeggiatore::Blink(long up, long down) { void Lampeggiatore::High() { // Accende il LED - digitalWrite(ledPin, HIGH); } void Lampeggiatore::Low() { // Spegne il LED - digitalWrite(ledPin, LOW); } void Lampeggiatore::Swap() { // Inverte lo stato del LED - - digitalWrite(ledPin, !digitalRead(ledPin)); + digitalWrite(ledPin, !digitalRead(ledPin)); } ///////////////////////////////////// // Pwm // Constructor Pwm::Pwm(int pin) - // Gestione del PWM utilizzando millis - // per non bloccare il processore con delay - // Warning: serialWrite puo' interferire con i tempi. +// Gestione del PWM utilizzando millis +// per non bloccare il processore con delay +// Warning: serialWrite puo' interferire con i tempi. { ledPin = pin; pinMode(ledPin, OUTPUT); @@ -182,71 +212,76 @@ Pwm::Pwm(int pin) increment = 1; }; -void Pwm::Up(long speed) { +void Pwm::Up(long speed, long drift) { // Aumenta linearmente la luminosita' usanndo millis() // quindi senza bloccare il processore // Viene usato un float, in alternativa un coseno if (millis() != previousMillis) { // si potrebbe togliere - brightness = 255.0 /(float)speed * millis() ; - analogWrite(ledPin, brightness); + shift = drift; + brightness = 255.0 /(float)speed * (millis() + shift); + analogWrite(ledPin, brightness); previousMillis = millis(); }; } -void Pwm::lUp(long speed) { +void Pwm::lUp(long speed, long drift) { // Aumenta usanndo millis() con correzione luminosita' LED // quindi senza bloccare il processore // Viene usato un float, in alternativa un coseno if (millis() != previousMillis) { // si potrebbe togliere - brightness = 255.0 /(float)speed * millis() ; - analogWrite(ledPin, lum(brightness)); + shift = drift; + brightness = 255.0 /(float)speed * (millis() + shift); + analogWrite(ledPin, lum(brightness)); previousMillis = millis(); }; } -void Pwm::Down(long speed ) { +void Pwm::Down(long speed, long drift) { // Riduce linearmente la luminosita' usanndo millis() // quindi senza bloccare il processore if (millis() != previousMillis) { - brightness = 255 - 255.0 /(float)speed * millis() ; - analogWrite(ledPin, brightness); + shift = drift; + brightness = 255 - 255.0 /(float)speed * (millis() + shift) ; + analogWrite(ledPin, brightness); previousMillis = millis(); }; } -void Pwm::lDown(long speed ) { +void Pwm::lDown(long speed, long drift) { // Riduce usanndo millis() con correzione della luminosita' // quindi senza bloccare il processore if (millis() != previousMillis) { - brightness = 255 - 255.0 /(float)speed * millis() ; - analogWrite(ledPin, lum(brightness)); + shift = drift; + brightness = 255 - 255.0 /(float)speed * (millis() + shift) ; + analogWrite(ledPin, lum(brightness)); previousMillis = millis(); }; } -void Pwm::UD(long speed ) { +void Pwm::UD(long speed, long drift ) { // Aumenta e riduce in sequenza la luminosita' usanndo millis() - brightness = 128 + 127 * cos(2 * PI / speed * millis()); - analogWrite(ledPin, brightness); + shift = drift; + brightness = 128 + 127 * cos(2 * PI / speed * (millis() + shift)); + analogWrite(ledPin, brightness); } void Pwm::Set(byte brightness) { - // Imposta il valore del PWM - analogWrite(ledPin, brightness); + // Imposta il valore del PWM + analogWrite(ledPin, brightness); } void Pwm::lSet(byte brightness) { - // Imposta il valore del PWM - analogWrite(ledPin, lum(brightness)); + // Imposta il valore del PWM con correzione luminosita' LED + analogWrite(ledPin, lum(brightness)); } @@ -327,20 +362,69 @@ void Sequenza::UD(long value) { void brilla(byte pin, int velocita ) { // Defalt value di velocita' solo nell'Header - // Accende e spegne il LED accetando un argomento - // per impostare la velocita'. - -pinMode(pin, OUTPUT); - // sequenze di istruzione: accendere e spegnere il LED - digitalWrite(pin, HIGH); // turn the LED on (HIGH is the voltage level) - delay(velocita); // wait for a second - digitalWrite(pin, LOW); // turn the LED off by making the voltage LOW - delay(velocita); // wait for a second + // Accende e spegne il LED accetando un argomento + // per impostare la velocita'. + + pinMode(pin, OUTPUT); + // sequenze di istruzione: accendere e spegnere il LED + digitalWrite(pin, HIGH); // turn the LED on (HIGH is the voltage level) + delay(velocita); // wait for a second + digitalWrite(pin, LOW); // turn the LED off by making the voltage LOW + delay(velocita); // wait for a second }; -byte lum(byte val) { +byte lum(byte val) { // Mappatura dell'intervallo 0-255 con correzione di luminosita. // storata in SRAM -return pgm_read_byte_near(BCORRECT + val); + return pgm_read_byte_near(BCORRECT + val); }; + + +int calibraTrim(int pin, const byte ledPin) { + /* START Calibrazione TRIM canale: + Lettura di 10 smaple + calcolo del valore medio esclusi gli 0 + + I canali come alettoni / elevatore possono avere un TRIM + (generalmente il throttle non ha un TRIM impostato), + questa funzione nel setup serve per trovare il punto medio + all'avvio dello sketch. + */ + pinMode(ledPin,OUTPUT); + byte a = 0; + int servoValue = 0; + int middle = 0; +#ifdef DEBUG + Serial.println(">> Calibrazione: "); +#endif + while (a < 10) { + if (millis() > 10000) { +#ifdef DEBUG + Serial.println(">> Calibrazione annullata a causa di assenza di seganle. \nAssicurarsi di accendere radio e ricevente \ne ripetere la procedura."); +#endif + middle = 15000; // Return value is divided by 10 + break; + }; + servoValue = pulseIn(pin, HIGH, 25000); + if (servoValue != 0 && servoValue > 950 && servoValue <2000) { + middle = middle + servoValue ; + a++ ; +#ifdef DEBUG + Serial.print(servoValue); + Serial.print(": "); + Serial.println(middle / a); +#endif + digitalWrite(ledPin, !digitalRead(ledPin)); + delay(50); + } + } +#ifdef DEBUG + Serial.print(">> Fine Calibrazione, media: "); + Serial.println(middle / 10 + 10); + Serial.flush() ; +#endif + return(middle / 10 ) ; +// END calibrazione +}; +