zhaw_st16b_pes2_10 / Mbed 2 deprecated PES_Official-US

a

Dependencies:   Servo ServoArm mbed

Fork of PES_Official-TestF by zhaw_st16b_pes2_10

Sources/Greifer.cpp@11:292bdbd85a9c, 2017-05-06 (annotated)

Committer:
beacon
Date:
Sat May 06 13:33:23 2017 +0000
Revision:
11:292bdbd85a9c
Parent:
10:f76476943a6c
Child:
12:c0bcb95885dd
Nenne dieses Programm "PES_Official" und l?sche das alte.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
beacon 10:f76476943a6c 1 #include "Robot.h"
beacon 10:f76476943a6c 2 #include "Declarations.h"
beacon 10:f76476943a6c 3
beacon 10:f76476943a6c 4
beacon 10:f76476943a6c 5
beacon 10:f76476943a6c 6
beacon 10:f76476943a6c 7
beacon 10:f76476943a6c 8
beacon 10:f76476943a6c 9 Greifer::Greifer(Servo* greifer)
beacon 10:f76476943a6c 10 {
beacon 10:f76476943a6c 11 init(greifer);
beacon 10:f76476943a6c 12 }
beacon 10:f76476943a6c 13
beacon 10:f76476943a6c 14 Greifer::Greifer()
beacon 10:f76476943a6c 15 {
beacon 10:f76476943a6c 16
beacon 10:f76476943a6c 17 }
beacon 10:f76476943a6c 18
beacon 10:f76476943a6c 19 void Greifer::init(Servo* greifer)
beacon 10:f76476943a6c 20 {
beacon 10:f76476943a6c 21 this->greifer = greifer;
beacon 10:f76476943a6c 22 greifer->calibrate(0.0015f, 180.0f);
beacon 10:f76476943a6c 23 greifer->position(85.0f);
beacon 10:f76476943a6c 24 }
beacon 10:f76476943a6c 25
beacon 11:292bdbd85a9c 26 int Greifer::take()
beacon 10:f76476943a6c 27 {
beacon 10:f76476943a6c 28 this->greifer->position(-150.0f);
beacon 11:292bdbd85a9c 29 static int time = 0;
beacon 11:292bdbd85a9c 30 if( time < 10 ){
beacon 11:292bdbd85a9c 31 time++;
beacon 11:292bdbd85a9c 32 return 0;
beacon 11:292bdbd85a9c 33 }
beacon 11:292bdbd85a9c 34 else{
beacon 11:292bdbd85a9c 35 return 1;
beacon 11:292bdbd85a9c 36 }
beacon 10:f76476943a6c 37 }
beacon 10:f76476943a6c 38
beacon 11:292bdbd85a9c 39 int Greifer::leave()
beacon 10:f76476943a6c 40 {
beacon 10:f76476943a6c 41 this->greifer->position(85.0f);
beacon 11:292bdbd85a9c 42 static int time = 0;
beacon 11:292bdbd85a9c 43 if( time < 10 ){
beacon 11:292bdbd85a9c 44 time++;
beacon 11:292bdbd85a9c 45 return 0;
beacon 11:292bdbd85a9c 46 }
beacon 11:292bdbd85a9c 47 else{
beacon 11:292bdbd85a9c 48 return 1;
beacon 11:292bdbd85a9c 49 }
beacon 10:f76476943a6c 50 }