vf
Dependencies: Servo ServoArm mbed
Fork of PES_Official by
Sources/Leiste.cpp
- Committer:
- EpicG10
- Date:
- 2017-05-11
- Revision:
- 15:915f8839fe48
- Parent:
- 14:b61fbd13a7c9
- Child:
- 16:f157e5ccd7d3
File content as of revision 15:915f8839fe48:
#include "Robot.h" #include "Declarations.h" Leiste::Leiste(){ } Leiste::Leiste(Servo* leiste){ init(leiste); } void Leiste::init(Servo* leiste){ this->leiste = leiste; this->leiste->calibrate(0.0025f, 180.0f); this->leiste->position(UP_POS); } int Leiste::UpToDown(){ static float pos=UP_POS; if(pos>DOWN_POS) { pos-=3; this->leiste->position(pos); return 0; } else{ pos = UP_POS; return 1; } } int Leiste::DownToUp(){ static float pos=DOWN_POS; if(pos<UP_POS) { pos+=3; this->leiste->position(pos); return 0; } else{ pos = DOWN_POS; return 1; } }