[390] | 1 | // created: 2020/12/21
|
---|
| 2 | // filename: SimpleFleet.h
|
---|
| 3 | //
|
---|
| 4 | // author: Guillaume Sanahuja
|
---|
| 5 | // Copyright Heudiasyc UMR UTC/CNRS 7253
|
---|
| 6 | //
|
---|
| 7 | // version: $Id: $
|
---|
| 8 | //
|
---|
| 9 | // purpose: demo simple fleet avec optitrack
|
---|
| 10 | //
|
---|
| 11 | //
|
---|
| 12 | /*********************************************************************/
|
---|
| 13 |
|
---|
| 14 | #ifndef SIMPLEFLEET_H
|
---|
| 15 | #define SIMPLEFLEET_H
|
---|
| 16 |
|
---|
| 17 | #include <Thread.h>
|
---|
| 18 |
|
---|
| 19 | namespace flair {
|
---|
| 20 | namespace core {
|
---|
| 21 | class UdpSocket;
|
---|
| 22 | }
|
---|
| 23 | namespace gui {
|
---|
| 24 | class PushButton;
|
---|
| 25 | class DoubleSpinBox;
|
---|
| 26 | }
|
---|
| 27 | namespace filter {
|
---|
| 28 | class TrajectoryGenerator2DCircle;
|
---|
| 29 | class Pid;
|
---|
| 30 | }
|
---|
| 31 | namespace meta {
|
---|
| 32 | class MetaVrpnObject;
|
---|
| 33 | }
|
---|
| 34 | namespace sensor {
|
---|
| 35 | class TargetController;
|
---|
| 36 | }
|
---|
| 37 | }
|
---|
| 38 |
|
---|
| 39 | class SimpleFleet : public flair::core::Thread {
|
---|
| 40 | public:
|
---|
| 41 | SimpleFleet(std::string name,std::string broadcast,flair::sensor::TargetController *controller);
|
---|
| 42 | ~SimpleFleet();
|
---|
| 43 |
|
---|
| 44 | private:
|
---|
| 45 |
|
---|
| 46 | enum class BehaviourMode_t {
|
---|
| 47 | Manual,
|
---|
| 48 | Circle
|
---|
| 49 | };
|
---|
| 50 |
|
---|
| 51 | void Run(void);
|
---|
| 52 | void StartCircle(void);
|
---|
| 53 | void StopCircle(void);
|
---|
| 54 | void ComputeManualControls(void);
|
---|
| 55 | void ComputeCircleControls(void);
|
---|
| 56 | void SecurityCheck(void);
|
---|
| 57 | void CheckMessages(void);
|
---|
| 58 | void CheckJoystick(void);
|
---|
| 59 | void CheckPushButton(void);
|
---|
| 60 |
|
---|
| 61 | flair::filter::Pid *uX, *uY;
|
---|
| 62 | flair::gui::PushButton *startCircle,*stopCircle,*button_kill;
|
---|
| 63 | flair::gui::DoubleSpinBox *l;
|
---|
| 64 | flair::gui::DoubleSpinBox *xCircleCenter,*yCircleCenter;
|
---|
| 65 | flair::meta::MetaVrpnObject *ugvVrpn;
|
---|
| 66 | flair::filter::TrajectoryGenerator2DCircle *circle;
|
---|
| 67 | BehaviourMode_t behaviourMode;
|
---|
| 68 | bool vrpnLost;
|
---|
| 69 | flair::sensor::TargetController *controller;
|
---|
| 70 | flair::core::UdpSocket *message;
|
---|
| 71 | };
|
---|
| 72 |
|
---|
| 73 | #endif // SIMPLEFLEET_H
|
---|