Matthias Grob / Mbed 2 deprecated FlyBedLight

Lightweight FlyBed1, structure based on KK-Board Firmware First this one should work, then I can get more complex FlyBed1 working :)

Dependencies:   mbed MODI2C

RC/RC_Channel.cpp@3:9cde4e9740fc, 2015-11-19 (annotated)

Committer:
maetugr
Date:
Thu Nov 19 18:52:48 2015 +0000
Revision:
3:9cde4e9740fc
Parent:
0:d51bf879e9df 
corrected a comment

Who changed what in which revision?

UserRevisionLine numberNew contents of line
maetugr 0:d51bf879e9df 1 #include "RC_Channel.h"
maetugr 0:d51bf879e9df 2 #include "mbed.h"
maetugr 0:d51bf879e9df 3
maetugr 0:d51bf879e9df 4 RC_Channel::RC_Channel(PinName mypin, int index) : myinterrupt(mypin)
maetugr 0:d51bf879e9df 5 {
maetugr 0:d51bf879e9df 6 LocalFileSystem local("local"); // If theres no local yet
maetugr 0:d51bf879e9df 7 RC_Channel::index = index;
maetugr 0:d51bf879e9df 8 time = -100; // start value to see if there was any value yet
maetugr 0:d51bf879e9df 9
maetugr 0:d51bf879e9df 10 loadCalibrationValue(&scale, "SCALE");
maetugr 0:d51bf879e9df 11 loadCalibrationValue(&offset, "OFFSE");
maetugr 0:d51bf879e9df 12
maetugr 0:d51bf879e9df 13 myinterrupt.rise(this, &RC_Channel::rise);
maetugr 0:d51bf879e9df 14 myinterrupt.fall(this, &RC_Channel::fall);
maetugr 0:d51bf879e9df 15 timeoutchecker.attach(this, &RC_Channel::timeoutcheck, 1);
maetugr 0:d51bf879e9df 16 }
maetugr 0:d51bf879e9df 17
maetugr 0:d51bf879e9df 18 int RC_Channel::read()
maetugr 0:d51bf879e9df 19 {
maetugr 0:d51bf879e9df 20 if(time == -100)
maetugr 0:d51bf879e9df 21 return time;
maetugr 0:d51bf879e9df 22 return scale * (float)(time) + offset; // calibration of the readings
maetugr 0:d51bf879e9df 23 }
maetugr 0:d51bf879e9df 24
maetugr 0:d51bf879e9df 25 void RC_Channel::rise()
maetugr 0:d51bf879e9df 26 {
maetugr 0:d51bf879e9df 27 timer.start();
maetugr 0:d51bf879e9df 28 }
maetugr 0:d51bf879e9df 29
maetugr 0:d51bf879e9df 30 void RC_Channel::fall()
maetugr 0:d51bf879e9df 31 {
maetugr 0:d51bf879e9df 32 timer.stop();
maetugr 0:d51bf879e9df 33 int tester = timer.read_us();
maetugr 0:d51bf879e9df 34 if(tester >= 1000 && tester <=2000)
maetugr 0:d51bf879e9df 35 time = tester-1000; // we want only the signal from 1000 on
maetugr 0:d51bf879e9df 36 timer.reset();
maetugr 0:d51bf879e9df 37 timer.start();
maetugr 0:d51bf879e9df 38 }
maetugr 0:d51bf879e9df 39
maetugr 0:d51bf879e9df 40 void RC_Channel::timeoutcheck()
maetugr 0:d51bf879e9df 41 {
maetugr 0:d51bf879e9df 42 if (timer.read() > 0.3)
maetugr 0:d51bf879e9df 43 time = -100;
maetugr 0:d51bf879e9df 44 }
maetugr 0:d51bf879e9df 45
maetugr 0:d51bf879e9df 46 void RC_Channel::saveCalibrationValue(float * value, char * fileextension)
maetugr 0:d51bf879e9df 47 {
maetugr 0:d51bf879e9df 48 char path[40];
maetugr 0:d51bf879e9df 49 sprintf(path, "/local/FlyBed/RC_%d_%s", index, fileextension);
maetugr 0:d51bf879e9df 50 FILE *fp = fopen(path, "w");
maetugr 0:d51bf879e9df 51 if (fp != NULL) {
maetugr 0:d51bf879e9df 52 fprintf(fp, "%f", value);
maetugr 0:d51bf879e9df 53 fclose(fp);
maetugr 0:d51bf879e9df 54 } else
maetugr 0:d51bf879e9df 55 value = 0;
maetugr 0:d51bf879e9df 56 }
maetugr 0:d51bf879e9df 57
maetugr 0:d51bf879e9df 58 void RC_Channel::loadCalibrationValue(float * value, char * fileextension)
maetugr 0:d51bf879e9df 59 {
maetugr 0:d51bf879e9df 60 char path[40];
maetugr 0:d51bf879e9df 61 sprintf(path, "/local/RC%d%s", index, fileextension);
maetugr 0:d51bf879e9df 62 FILE *fp = fopen(path, "r");
maetugr 0:d51bf879e9df 63 if (fp != NULL) {
maetugr 0:d51bf879e9df 64 fscanf(fp, "%f", value);
maetugr 0:d51bf879e9df 65 fclose(fp);
maetugr 0:d51bf879e9df 66 } else
maetugr 0:d51bf879e9df 67 value = 0;
maetugr 0:d51bf879e9df 68 }