Geert Huisman / IR_Distance

GP20A41SK IR sensor

IR_Dist.cpp@0:a17fcd8e5d32, 2017-07-03 (annotated)

Committer:
mrvalon
Date:
Mon Jul 03 23:07:51 2017 +0000
Revision:
0:a17fcd8e5d32
GP20A41SK IR Distance sensor

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mrvalon 0:a17fcd8e5d32 1 #include "IR_Dist.h"
mrvalon 0:a17fcd8e5d32 2 #include "mbed.h"
mrvalon 0:a17fcd8e5d32 3 /*
mrvalon 0:a17fcd8e5d32 4 *IR_Dist.cpp
mrvalon 0:a17fcd8e5d32 5 */
mrvalon 0:a17fcd8e5d32 6 IR_Dist::IR_Dist(PinName a) : IRSens(a){}
mrvalon 0:a17fcd8e5d32 7
mrvalon 0:a17fcd8e5d32 8 float IR_Dist::Equation() {
mrvalon 0:a17fcd8e5d32 9 volts = IRSens.read_u16()* 0.02441406; // 5v / 2048 = 0.02441406
mrvalon 0:a17fcd8e5d32 10
mrvalon 0:a17fcd8e5d32 11 return 5034.2 * pow(volts,-0.959); // x = 5034.2x-0.959
mrvalon 0:a17fcd8e5d32 12 }
mrvalon 0:a17fcd8e5d32 13
mrvalon 0:a17fcd8e5d32 14 //return distance in cm
mrvalon 0:a17fcd8e5d32 15 float IR_Dist::distance(){
mrvalon 0:a17fcd8e5d32 16 correction = 1;
mrvalon 0:a17fcd8e5d32 17 som = Equation();
mrvalon 0:a17fcd8e5d32 18 distance_cm = (som - correction);
mrvalon 0:a17fcd8e5d32 19
mrvalon 0:a17fcd8e5d32 20 return distance_cm;
mrvalon 0:a17fcd8e5d32 21
mrvalon 0:a17fcd8e5d32 22 }