José Claudio / Mbed 2 deprecated QuadCopter-Sensor-Serial

Quadcopter working with accelerômeter and accelerometer, and bluetooth radio for communication

Dependencies:   mbed

Util.cpp@0:56b8c86181b1, 2013-05-21 (annotated)

Committer:
jose_claudiojr
Date:
Tue May 21 14:12:13 2013 +0000
Revision:
0:56b8c86181b1
Quadcopter code with accelerometer and gyroscope.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
jose_claudiojr 0:56b8c86181b1 1 #include "Util.h"
jose_claudiojr 0:56b8c86181b1 2
jose_claudiojr 0:56b8c86181b1 3 int clampInt(int value, int min, int max)
jose_claudiojr 0:56b8c86181b1 4 {
jose_claudiojr 0:56b8c86181b1 5 if (value < min)
jose_claudiojr 0:56b8c86181b1 6 return min;
jose_claudiojr 0:56b8c86181b1 7 else if (value > max)
jose_claudiojr 0:56b8c86181b1 8 return max;
jose_claudiojr 0:56b8c86181b1 9
jose_claudiojr 0:56b8c86181b1 10 return value;
jose_claudiojr 0:56b8c86181b1 11 }
jose_claudiojr 0:56b8c86181b1 12
jose_claudiojr 0:56b8c86181b1 13 float clampFloat(float value, float min, float max)
jose_claudiojr 0:56b8c86181b1 14 {
jose_claudiojr 0:56b8c86181b1 15 if (value < min)
jose_claudiojr 0:56b8c86181b1 16 return min;
jose_claudiojr 0:56b8c86181b1 17 else if (value > max)
jose_claudiojr 0:56b8c86181b1 18 return max;
jose_claudiojr 0:56b8c86181b1 19
jose_claudiojr 0:56b8c86181b1 20 return value;
jose_claudiojr 0:56b8c86181b1 21 }
jose_claudiojr 0:56b8c86181b1 22 /*
jose_claudiojr 0:56b8c86181b1 23 float abs(float value)
jose_claudiojr 0:56b8c86181b1 24 {
jose_claudiojr 0:56b8c86181b1 25 if(value < 0)
jose_claudiojr 0:56b8c86181b1 26 return ((-1)*value);
jose_claudiojr 0:56b8c86181b1 27
jose_claudiojr 0:56b8c86181b1 28 return value;
jose_claudiojr 0:56b8c86181b1 29 }
jose_claudiojr 0:56b8c86181b1 30 */
jose_claudiojr 0:56b8c86181b1 31 float norm(float val1, float val2, float val3)
jose_claudiojr 0:56b8c86181b1 32 {
jose_claudiojr 0:56b8c86181b1 33 return sqrt(pow(val1,2)+pow(val2,2)+pow(val3,2));
jose_claudiojr 0:56b8c86181b1 34 }