00001 #pragma once 00002 00021 #ifndef __KIFLYTO_H 00022 #define __KIFLYTO_H 00023 00024 00025 #include "KIProcedure.h" 00026 00027 class KIFlyTo : public KIProcedure 00028 { 00029 private: 00030 int reachedAtClock; 00031 bool reached; 00032 bool targetSet; 00033 bool isCompleted; 00034 00035 int stayTimeMs; 00036 double maxControlFactor; 00037 double initialReachedDist; 00038 double stayWithinDist; 00039 00040 00041 DronePosition checkpoint; 00042 00043 public: 00044 KIFlyTo(DronePosition checkpoint, 00045 double stayTime = 2, 00046 double maxControlFactorP = 1, 00047 double initialReachedDistP = 0.2, 00048 double stayWithinDistP = 0.5); 00049 00050 ~KIFlyTo(void); 00051 bool update(const tum_ardrone::filter_stateConstPtr statePtr); 00052 }; 00053 00054 #endif /* __KIFLYTO_H */