Matthias Grob / Mbed 2 deprecated FlyBed2

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

Dependents:   fluy343

RC/RC_Channel.cpp@0:12950aa67f2a, 2013-09-02 (annotated)

Committer:
maetugr
Date:
Mon Sep 02 15:04:22 2013 +0000
Revision:
0:12950aa67f2a
Child:
7:ac2895479e34
first commit of new version (only one axis for test until now); note: no more Ticker! (made problems because of interrupts)

Who changed what in which revision?

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