![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
a
Dependencies: Servo ServoArm mbed
Fork of PES_Official-TestF by
Sources/USsensor.cpp
- Committer:
- beacon
- Date:
- 2017-05-18
- Revision:
- 17:4e1be70bdedb
- Child:
- 18:a158713a0049
File content as of revision 17:4e1be70bdedb:
#include <Robot.h> USsensor::USsensor() { } USsensor::USsensor(Ultraschall* Usensor) { init(Usensor); } void USsensor::init(Ultraschall* Usensor) { this->Usensor = Usensor; } float USsensor::read() { static int i = 0; Usensor->start(); if( i ){ float dist = Usensor->get_dist_cm(); static float distFiltered = dist; distFiltered = 0.05f * distFiltered + 0.95f * dist; return distFiltered / 100; //return dist/100.0f; } else{ i++; return 0.25f; } } USsensor::operator float() { return read(); }