zhaw_st16b_pes2_10 / Mbed 2 deprecated PES_Official

Dependencies:   mbed Servo ServoArm

Fork of PES_Yanick by zhaw_st16b_pes2_10

Revision:
8:593f82e66bdf
Parent:
6:ba26dd3251b3
Child:
9:ac362674c480
--- a/Sources/Arm.cpp	Wed Apr 26 14:09:08 2017 +0000
+++ /dev/null	Thu Jan 01 00:00:00 1970 +0000
@@ -1,61 +0,0 @@
-#include "Robot.h"
-#include "Declarations.h"
-
-
-Arm::Arm(){
-}
-
-Arm::Arm(Servo* servoArm){
-    init(servoArm);
-}
-
-void Arm::init(Servo* servoArm){
-    this->servoArm = servoArm;
-    
-    this->servoArm->calibrate(0.0015f, 180.0f);
-    this->servoArm->position(COLLECT_POS);
-}
-
-void Arm::collecttodown(int* done){
-    static float pos=COLLECT_POS;
-    if(pos>TAKE_POS) {
-        pos-=0.5f;
-        this->servoArm->position(pos);
-    }
-    else{
-        *done = 1;
-    }
-}
-
-void Arm::downtocollect(int* done){
-    static float pos=TAKE_POS;
-    if(pos<COLLECT_POS) {
-        pos+=0.5f;
-        this->servoArm->position(pos);
-        }
-    else{
-        *done = 1;
-    }
-}
-
-void Arm::collecttoback(int* done){
-    static float pos=COLLECT_POS;
-    if(pos<RELEASE_POS) {
-        pos+=0.5f;
-        this->servoArm->position(pos);
-        }
-    else{
-        *done = 1;
-    }
-}
-
-void Arm::backtocollect(int* done){
-    static float pos=RELEASE_POS;
-    if(pos>COLLECT_POS) {
-        pos-=0.5f;
-        this->servoArm->position(pos);
-        }
-    else{
-        *done = 1;
-    }
-}
\ No newline at end of file