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