Helvijs Kiselis
/
Micromouse
Algorithmus
IRSensor.cpp@10:84534846e1f1, 2018-04-30 (annotated)
- Committer:
- luethale
- Date:
- Mon Apr 30 13:28:28 2018 +0000
- Revision:
- 10:84534846e1f1
- Parent:
- 3:076dd7ec7eb4
Clean up; volatile for; route[]; junction[]; j
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Helvis | 1:2b5f79285a3e | 1 | #include <cmath> |
Helvis | 1:2b5f79285a3e | 2 | #include "IRSensor.h" |
Helvis | 1:2b5f79285a3e | 3 | |
Helvis | 1:2b5f79285a3e | 4 | using namespace std; |
Helvis | 1:2b5f79285a3e | 5 | |
Helvis | 1:2b5f79285a3e | 6 | IRSensor::IRSensor(AnalogIn& distance) : |
Helvis | 1:2b5f79285a3e | 7 | distance(distance){} |
Helvis | 1:2b5f79285a3e | 8 | |
Helvis | 1:2b5f79285a3e | 9 | IRSensor::~IRSensor() {} |
Helvis | 1:2b5f79285a3e | 10 | |
Helvis | 1:2b5f79285a3e | 11 | float IRSensor::readL() { |
Helvis | 1:2b5f79285a3e | 12 | |
Helvis | 3:076dd7ec7eb4 | 13 | float d2 = 10.2817f*(1/(pow(distance,1.212121f))); |
Helvis | 1:2b5f79285a3e | 14 | |
Helvis | 1:2b5f79285a3e | 15 | return d2; |
Helvis | 1:2b5f79285a3e | 16 | |
Helvis | 1:2b5f79285a3e | 17 | } |
Helvis | 1:2b5f79285a3e | 18 | |
Helvis | 1:2b5f79285a3e | 19 | float IRSensor::readR(){ |
Helvis | 1:2b5f79285a3e | 20 | |
Helvis | 3:076dd7ec7eb4 | 21 | float d1 = 11.6037f*(1/(pow(distance,1.111111f))); |
Helvis | 1:2b5f79285a3e | 22 | |
Helvis | 1:2b5f79285a3e | 23 | return d1; |
Helvis | 1:2b5f79285a3e | 24 | } |
Helvis | 1:2b5f79285a3e | 25 | |
Helvis | 1:2b5f79285a3e | 26 | float IRSensor::readC(){ |
Helvis | 1:2b5f79285a3e | 27 | |
Helvis | 3:076dd7ec7eb4 | 28 | float d4 = 28.053f*(1.0f/distance); |
Helvis | 1:2b5f79285a3e | 29 | |
Helvis | 1:2b5f79285a3e | 30 | return d4; |
luethale | 10:84534846e1f1 | 31 | } |