Do NOT modify!
Dependencies: mbed Servo ServoArm
Fork of PES_Yanick by
Sources/Greifer.cpp
- Committer:
- beacon
- Date:
- 2017-05-06
- Revision:
- 11:292bdbd85a9c
- Parent:
- 10:f76476943a6c
- Child:
- 12:c0bcb95885dd
File content as of revision 11:292bdbd85a9c:
#include "Robot.h" #include "Declarations.h" Greifer::Greifer(Servo* greifer) { init(greifer); } Greifer::Greifer() { } void Greifer::init(Servo* greifer) { this->greifer = greifer; greifer->calibrate(0.0015f, 180.0f); greifer->position(85.0f); } int Greifer::take() { this->greifer->position(-150.0f); static int time = 0; if( time < 10 ){ time++; return 0; } else{ return 1; } } int Greifer::leave() { this->greifer->position(85.0f); static int time = 0; if( time < 10 ){ time++; return 0; } else{ return 1; } }