k

Dependencies:   Servo ServoArm mbed

Committer:
beacon
Date:
Mon May 22 11:24:46 2017 +0000
Revision:
0:15a8480061e8
o

Who changed what in which revision?

UserRevisionLine numberNew contents of line
beacon 0:15a8480061e8 1 #include "Robot.h"
beacon 0:15a8480061e8 2 #include "Declarations.h"
beacon 0:15a8480061e8 3
beacon 0:15a8480061e8 4
beacon 0:15a8480061e8 5 Leiste::Leiste(){
beacon 0:15a8480061e8 6 }
beacon 0:15a8480061e8 7
beacon 0:15a8480061e8 8 Leiste::Leiste(Servo* leiste){
beacon 0:15a8480061e8 9 init(leiste);
beacon 0:15a8480061e8 10 }
beacon 0:15a8480061e8 11
beacon 0:15a8480061e8 12 void Leiste::init(Servo* leiste){
beacon 0:15a8480061e8 13 this->leiste = leiste;
beacon 0:15a8480061e8 14 this->leiste->calibrate(0.0025f, 180.0f);
beacon 0:15a8480061e8 15 this->leiste->position(UP_POS);
beacon 0:15a8480061e8 16 }
beacon 0:15a8480061e8 17
beacon 0:15a8480061e8 18 int Leiste::upToDown(){
beacon 0:15a8480061e8 19 static float pos=UP_POS;
beacon 0:15a8480061e8 20 if(pos>DOWN_POS) {
beacon 0:15a8480061e8 21 pos-=3;
beacon 0:15a8480061e8 22 this->leiste->position(pos);
beacon 0:15a8480061e8 23 return 0;
beacon 0:15a8480061e8 24 }
beacon 0:15a8480061e8 25 else{
beacon 0:15a8480061e8 26 pos = UP_POS;
beacon 0:15a8480061e8 27 return 1;
beacon 0:15a8480061e8 28 }
beacon 0:15a8480061e8 29 }
beacon 0:15a8480061e8 30
beacon 0:15a8480061e8 31 int Leiste::downToUp(){
beacon 0:15a8480061e8 32 static float pos=DOWN_POS;
beacon 0:15a8480061e8 33 if(pos<UP_POS) {
beacon 0:15a8480061e8 34 pos+=3;
beacon 0:15a8480061e8 35 this->leiste->position(pos);
beacon 0:15a8480061e8 36 return 0;
beacon 0:15a8480061e8 37 }
beacon 0:15a8480061e8 38 else{
beacon 0:15a8480061e8 39 pos = DOWN_POS;
beacon 0:15a8480061e8 40 return 1;
beacon 0:15a8480061e8 41 }
beacon 0:15a8480061e8 42 }