zhaw_st16b_pes2_10 / Mbed 2 deprecated PES_Official

Do NOT modify!

Dependencies:   mbed Servo ServoArm

Fork of PES_Yanick by zhaw_st16b_pes2_10

Sources/Greifer.cpp

Committer:
beacon
Date:
2017-05-03
Revision:
10:f76476943a6c
Child:
11:292bdbd85a9c

File content as of revision 10:f76476943a6c:

#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);
}

void Greifer::take()
{
    this->greifer->position(-150.0f);
}

void Greifer::leave()
{
    this->greifer->position(85.0f);
}