#ifndef ROBOMON_ATLANTIS_H
#define ROBOMON_ATLANTIS_H
-#define SIM_OBST_SIZE_M 0.5
-
#include <QDialog>
+#include <QDateTime>
+#include <QTimer>
#include <trgen.h>
#include "PlaygroundScene.h"
+#include "playgroundview.h"
#include "Robot.h"
#include <roboorte_robottype.h>
-#include <roboorte.h>
+#include "trail.h"
+#include "hokuyoscan.h"
class QHBoxLayout;
class QVBoxLayout;
class QProgressBar;
class QFont;
+class MotorSimulation : QObject {
+ Q_OBJECT
+
+ QTimer timer;
+ qint64 last_time;
+ struct robottype_orte_data &orte;
+public:
+ MotorSimulation(struct robottype_orte_data &orte) : QObject(), timer(this), orte(orte) {}
+ void start()
+ {
+ robottype_publisher_motion_irc_create(&orte, 0, 0);
+ connect(&timer, SIGNAL(timeout()), this, SLOT(updateIRC()));
+ timer.start(50);
+ }
+
+ void stop()
+ {
+ robottype_publisher_motion_irc_destroy(&orte);
+ timer.stop();
+ disconnect(&timer, SIGNAL(timeout()), this, SLOT(updateIRC()));
+ }
+private slots:
+ void updateIRC()
+ {
+ qint64 now = QDateTime::currentMSecsSinceEpoch();
+ orte.motion_irc.left += orte.motion_speed.left * (now - last_time); // TODO: Find constant for speed to irc conversion
+ orte.motion_irc.right+= orte.motion_speed.right * (now - last_time);
+ ORTEPublicationSend(orte.publication_motion_irc);
+ last_time = now;
+ }
+};
+
+
class RobomonAtlantis : public QWidget
{
Q_OBJECT
signals:
void motionStatusReceivedSignal();
void actualPositionReceivedSignal();
- void estimatedPositionReceivedSignal();
- void diReceivedSignal();
- void accelerometerReceivedSignal();
- void accumulatorReceivedSignal();
void powerVoltageReceivedSignal();
-
+
+public slots:
+ void showMap(bool show);
+ void useOpenGL(bool use);
+ void showTrails(bool show);
+ void showShapeDetect(bool show);
+ void resetTrails();
private slots:
/************************************************************
* GUI actions
void setVoltage33(int state);
void setVoltage50(int state);
void setVoltage80(int state);
- void setLeftMotor(int value);
- void setRightMotor(int value);
- void stopMotors();
- void setDO(int state);
- void showMap();
- void showPlayground();
+/* void setLeftMotor(int value); */
+/* void setRightMotor(int value); */
+/* void stopMotors(); */
void paintMap();
void setSimulation(int state);
void setObstacleSimulation(int state);
void simulateObstaclesHokuyo();
void changeObstacle(QPointF position);
- void pick();
- void setBelts(int value);
- void setChelae(int value);
+ void sendStart(int plug);
+ void setTeamColor(int plug);
+ void setMotorSimulation(int state);
/************************************************************
* ORTE
************************************************************/
void motionStatusReceived();
void actualPositionReceived();
- void estimatedPositionReceived();
- void diReceived();
- void accelerometerReceived();
- void accumulatorReceived();
void powerVoltageReceived();
private:
void createPickerGroupBox();
void createFSMGroupBox();
- void createSharpSensorsLayout();
-
void createRobots();
void createActions();
QGroupBox *miscGroupBox;
QGroupBox *debugGroupBox;
QGroupBox *actuatorsGroupBox;
- QGroupBox *enginesGroupBox;
- QGroupBox *dioGroupBox;
- QGroupBox *sensorsGroupBox;
QGroupBox *powerGroupBox;
- QGroupBox *pickerGroupBox;
QGroupBox *fsmGroupBox;
+public:
PlaygroundScene *playgroundScene;
- QGraphicsView *playgroundSceneView;
+private:
+ PlaygroundView *playgroundSceneView;
/* position state */
QLineEdit *actPosX;
bool debugWindowEnabled;
/* actuators */
- QSlider *leftMotorSlider;
- QSlider *rightMotorSlider;
- QCheckBox *bothMotorsCheckBox;
- QPushButton *stopMotorsPushButton;
-
- QCheckBox *leftBeltCheckBox;
- QCheckBox *rightBeltCheckBox;
- QCheckBox *leftChelaCheckBox;
- QCheckBox *rightChelaCheckBox;
-
- QDial *leftBeltDial;
- QDial *rightBeltDial;
- QDial *leftChelaDial;
- QDial *rightChelaDial;
- QPushButton *pickPushButton;
+/* QSlider *leftMotorSlider; */
+/* QSlider *rightMotorSlider; */
+/* QCheckBox *bothMotorsCheckBox; */
+/* QPushButton *stopMotorsPushButton; */
+ //QDial *vidle;
/* power management */
QCheckBox *voltage33CheckBox;
QLineEdit *voltage80LineEdit;
QLineEdit *voltageBATLineEdit;
- QCheckBox *diCheckBox[8];
- QCheckBox *doCheckBox[8];
-
/* misc */
QCheckBox *obstacleSimulationCheckBox;
- QCheckBox *showMapPushButton;
+ QCheckBox *motorSimulationCheckBox;
QLabel *fsm_main_state;
QLabel *fsm_act_state;
QLabel *fsm_motion_state;
-
+ QCheckBox *startPlug;
+ QCheckBox *colorChoser;
+public:
/* robot */
- Robot *robotActPos;
- Robot *robotEstPos;
+ Robot *robotRefPos;
+ Robot *robotEstPosBest;
+ Robot *robotEstPosIndepOdo;
+ Robot *robotEstPosOdo;
+private:
+ Trail *trailRefPos;
+ Trail *trailEstPosBest;
+ Trail *trailPosIndepOdo;
+ Trail *trailOdoPos;
+
+ HokuyoScan *hokuyoScan;
/* keypad */
double leftMotorValue;
bool sharedMemoryOpened;
QTimer *mapTimer;
- /* sensors */
- QProgressBar *sharpPuck;
-
/* obstacle simulation */
double distanceToWallHokuyo(int beamnum);
double distanceToObstacleHokuyo(int beamnum, Point obstacle, double obstacleSize);
QTimer *obstacleSimulationTimer;
Point simulatedObstacle;
+ class MotorSimulation motorSimulation;
+
/************************************************************
* ORTE
************************************************************/