c
Dependencies: Servo ServoArm mbed
Fork of PES_PIXY_Official by
Sources/Leiste.cpp
- Committer:
- EpicG10
- Date:
- 2017-05-23
- Revision:
- 1:fd3cef0f116d
- Parent:
- 0:15a8480061e8
File content as of revision 1:fd3cef0f116d:
#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; } }