]> rtime.felk.cvut.cz Git - hubacji1/simple-stage.git/blob - ctrl/gobackward.cc
Add gobackward ctrl
[hubacji1/simple-stage.git] / ctrl / gobackward.cc
1 #include "stage.hh"
2 using namespace Stg;
3
4 class ControlledRobot {
5 private:
6         ModelPosition *pos = nullptr;
7 public:
8         ControlledRobot(Model *m) : pos(dynamic_cast<ModelPosition *>(m))
9         {
10                 assert(this->pos != nullptr);
11                 this->pos->Subscribe();
12         }
13         ModelPosition *get_pos() const { return this->pos; }
14 };
15
16 extern "C" int Init(Model *model, CtrlArgs *)
17 {
18         auto r = new ControlledRobot(model);
19         r->get_pos()->SetXSpeed(-3.0);
20         return 0;
21 }