RobotTestGUI.h

#ifndef ROBOTTESTGUI
#define ROBOTTESTGUI

#include "WorldGUI.h"
#include "View/RobotPoseWidget.h"
#include "View/ObjectPoseWidget.h"
#include "Sensing/Sensor.h"
#include "GLUIGUI.h"
#include <fstream>
using namespace Math3D;
using namespace GLDraw;

class RobotTestBackend : public WorldGUIBackend
{
public:
  Robot* robot;
  //internal state
  int cur_link,cur_driver;
  vector<bool> self_colliding;
  //temp: sensors storage
  RobotSensors robotSensors;

  int pose_ik,pose_objects;
  vector<RobotPoseWidget> robotWidgets;
  vector<RigidObjectPoseWidget> objectWidgets;
  WidgetSet allWidgets;
  GLDraw::Widget* lastActiveWidget;
  int draw_geom,draw_bbs,draw_com,draw_frame,draw_expanded,draw_sensors;
  int draw_self_collision_tests;
  int output_ros, ros_status;

  vector<GLDisplayList> originalDisplayLists,expandedDisplayLists;

  RobotTestBackend(RobotWorld* world);
  virtual void Start();
  void UpdateConfig();
  virtual void RenderWorld();
  virtual bool OnQuit();
  virtual bool OnButtonPress(const string& button);
  virtual bool OnButtonToggle(const string& button,int checked);
  virtual bool OnCommand(const string& cmd,const string& args);
  virtual void DoPassiveMouseMove(int x, int y);
  virtual void BeginDrag(int x,int y,int button,int modifiers);
  virtual void EndDrag(int x,int y,int button,int modifiers);
  virtual void DoFreeDrag(int dx,int dy,int button);
  void SetDrawExpanded(int value);
};

#if HAVE_GLUI

#if defined (__APPLE__) || defined (MACOSX)
#include <GL/glui.h>
#else
#include <GL/glui.h>
#endif //__APPLE__ || MACOSX

class GLUIRobotTestGUI : public GLUIGUI
{
 public:
  RobotWorld* world;
  Robot* robot;
  //GUI state
  GLUI* glui;
  GLUI_Spinner* link_spinner, *link_value_spinner;
  GLUI_Listbox* link_listbox;
  GLUI_StaticText* link_info;
  GLUI_Spinner* driver_spinner, *driver_value_spinner;
  GLUI_Listbox* driver_listbox;
  GLUI_StaticText* driver_info;
  int cur_link,cur_driver;

  GLUIRobotTestGUI(GenericBackendBase* backend,RobotWorld* world,int w=800,int h=600);
  virtual bool Initialize();
  virtual void Handle_Control(int id);
  virtual bool OnCommand(const string& cmd,const string& args);
  void UpdateGUI();
};
#endif //HAVE_GLUI
#endif //ROBOTTESTGUI