Drapeau

Dependencies:   mbed

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers Flag.cpp Source File

Flag.cpp

00001 #include "Flag.h"
00002 
00003 PwmOut servo(FLAGPIN);
00004 Timeout response;
00005 
00006 
00007 void FlagGOTO(int pos){
00008     servo = (pos*(0.05f)/90)+0.075f;
00009     }
00010 
00011 void FlagFROMGOTO(int posinit, int posfin, int pas){
00012     int dir = ((posfin - posinit)/abs(posfin - posinit));
00013     for(int pos = posinit; pos != posfin; pos = pos + (pas*dir)){
00014     FlagGOTO(pos);
00015     wait_ms(FLAGDELAY2POS);}
00016     }
00017 
00018 void FlagCCW(void){
00019     FlagGOTO(90);
00020     //servo = 0.125f;
00021  }
00022  
00023 void FlagMid(void){
00024     FlagGOTO(0);
00025     //servo = 0.075f;
00026  }
00027  
00028  void FlagCW(void){
00029     FlagGOTO(-90);
00030     //servo = 0.024f;
00031 }
00032 
00033 void FlagUpToInit(){
00034     FlagFROMGOTO(0, 90, 1);
00035     }
00036 
00037 void FlagInitToUp(){
00038     FlagFROMGOTO(90, 0, 1);
00039     }
00040 
00041 void Detonateur(float time){
00042     response.attach(&FlagInitToUp, time);
00043 }