JoystickWidget.cc 4.6 KB
Newer Older
pixhawk's avatar
pixhawk committed
1 2 3 4 5
#include "JoystickWidget.h"
#include "ui_JoystickWidget.h"
#include <QDebug>

JoystickWidget::JoystickWidget(JoystickInput* joystick, QWidget *parent) :
6 7
    QDialog(parent),
    m_ui(new Ui::JoystickWidget)
pixhawk's avatar
pixhawk committed
8 9
{
    m_ui->setupUi(this);
10
	clearKeys();
pixhawk's avatar
pixhawk committed
11 12
    this->joystick = joystick;

Lorenz Meier's avatar
Lorenz Meier committed
13 14 15 16 17 18
    m_ui->rollMapSpinBox->setValue(joystick->getMappingXAxis());
    m_ui->pitchMapSpinBox->setValue(joystick->getMappingYAxis());
    m_ui->yawMapSpinBox->setValue(joystick->getMappingYawAxis());
    m_ui->throttleMapSpinBox->setValue(joystick->getMappingThrustAxis());
    m_ui->autoMapSpinBox->setValue(joystick->getMappingAutoButton());

19
    connect(this->joystick, SIGNAL(joystickChanged(double,double,double,double,int,int,int)), this, SLOT(updateJoystick(double,double,double,double,int,int)));
pixhawk's avatar
pixhawk committed
20
    connect(this->joystick, SIGNAL(buttonPressed(int)), this, SLOT(pressKey(int)));
Lorenz Meier's avatar
Lorenz Meier committed
21 22 23 24 25
    connect(m_ui->rollMapSpinBox, SIGNAL(valueChanged(int)), this->joystick, SLOT(setMappingXAxis(int)));
    connect(m_ui->pitchMapSpinBox, SIGNAL(valueChanged(int)), this->joystick, SLOT(setMappingYAxis(int)));
    connect(m_ui->yawMapSpinBox, SIGNAL(valueChanged(int)), this->joystick, SLOT(setMappingYawAxis(int)));
    connect(m_ui->throttleMapSpinBox, SIGNAL(valueChanged(int)), this->joystick, SLOT(setMappingThrustAxis(int)));
    connect(m_ui->autoMapSpinBox, SIGNAL(valueChanged(int)), this->joystick, SLOT(setMappingAutoButton(int)));
pixhawk's avatar
pixhawk committed
26 27 28

    // Display the widget
    this->window()->setWindowTitle(tr("Joystick Settings"));
29 30
    if (joystick) updateStatus(tr("Found joystick: %1").arg(joystick->getName()));

pixhawk's avatar
pixhawk committed
31 32 33 34 35 36 37 38 39 40 41 42
    this->show();
}

JoystickWidget::~JoystickWidget()
{
    delete m_ui;
}

void JoystickWidget::updateJoystick(double roll, double pitch, double yaw, double thrust, int xHat, int yHat)
{
    setX(roll);
    setY(pitch);
pixhawk's avatar
pixhawk committed
43
    setZ(yaw);
pixhawk's avatar
pixhawk committed
44
    setThrottle(thrust);
pixhawk's avatar
pixhawk committed
45
    setHat(xHat, yHat);
pixhawk's avatar
pixhawk committed
46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63
}

void JoystickWidget::changeEvent(QEvent *e)
{
    switch (e->type()) {
    case QEvent::LanguageChange:
        m_ui->retranslateUi(this);
        break;
    default:
        break;
    }
}


void JoystickWidget::setThrottle(float thrust)
{
    m_ui->thrust->setValue(thrust*100);
}
pixhawk's avatar
pixhawk committed
64

pixhawk's avatar
pixhawk committed
65 66 67 68 69
void JoystickWidget::setX(float x)
{
    m_ui->xSlider->setValue(x*100);
    m_ui->xValue->display(x*100);
}
pixhawk's avatar
pixhawk committed
70

pixhawk's avatar
pixhawk committed
71 72 73 74 75
void JoystickWidget::setY(float y)
{
    m_ui->ySlider->setValue(y*100);
    m_ui->yValue->display(y*100);
}
pixhawk's avatar
pixhawk committed
76 77 78 79 80 81 82 83

void JoystickWidget::setZ(float z)
{
    m_ui->dial->setValue(z*100);
}

void JoystickWidget::setHat(float x, float y)
{
84
    updateStatus(tr("Hat position: x: %1, y: %2").arg(x).arg(y));
85 86 87 88 89 90
}

void JoystickWidget::clearKeys()
{
    QString colorstyle;
    QColor buttonStyleColor = QColor(200, 20, 20);
91 92 93 94 95 96 97 98 99 100 101 102 103
    colorstyle = QString("QLabel { border: 1px solid #EEEEEE; border-radius: 4px; padding: 0px; margin: 0px; background-color: %1;}").arg(buttonStyleColor.name());

    m_ui->button0->setStyleSheet(colorstyle);
    m_ui->button1->setStyleSheet(colorstyle);
    m_ui->button2->setStyleSheet(colorstyle);
    m_ui->button3->setStyleSheet(colorstyle);
    m_ui->button4->setStyleSheet(colorstyle);
    m_ui->button5->setStyleSheet(colorstyle);
    m_ui->button6->setStyleSheet(colorstyle);
    m_ui->button7->setStyleSheet(colorstyle);
    m_ui->button8->setStyleSheet(colorstyle);
    m_ui->button9->setStyleSheet(colorstyle);
    m_ui->button10->setStyleSheet(colorstyle);
pixhawk's avatar
pixhawk committed
104 105
}

pixhawk's avatar
pixhawk committed
106 107 108
void JoystickWidget::pressKey(int key)
{
    QString colorstyle;
109
    QColor buttonStyleColor = QColor(20, 200, 20);
110
    colorstyle = QString("QLabel { border: 1px solid #EEEEEE; border-radius: 4px; padding: 0px; margin: 0px; background-color: %1;}").arg(buttonStyleColor.name());
111
    switch(key) {
112
    case 0:
113
        m_ui->button0->setStyleSheet(colorstyle);
114 115
        break;
    case 1:
116
        m_ui->button1->setStyleSheet(colorstyle);
117 118
        break;
    case 2:
119
        m_ui->button2->setStyleSheet(colorstyle);
120 121
        break;
    case 3:
122
        m_ui->button3->setStyleSheet(colorstyle);
123 124
        break;
    case 4:
125
        m_ui->button4->setStyleSheet(colorstyle);
126 127
        break;
    case 5:
128
        m_ui->button5->setStyleSheet(colorstyle);
129 130
        break;
    case 6:
131
        m_ui->button6->setStyleSheet(colorstyle);
132 133
        break;
    case 7:
134
        m_ui->button7->setStyleSheet(colorstyle);
135 136
        break;
    case 8:
137
        m_ui->button8->setStyleSheet(colorstyle);
138 139
        break;
    case 9:
140 141 142 143
        m_ui->button9->setStyleSheet(colorstyle);
        break;
    case 10:
        m_ui->button10->setStyleSheet(colorstyle);
144 145 146 147 148 149 150 151
        break;
    }
    QTimer::singleShot(20, this, SLOT(clearKeys()));
    updateStatus(tr("Key %1 pressed").arg(key));
}

void JoystickWidget::updateStatus(const QString& status)
{
152
    m_ui->statusLabel->setText(status);
pixhawk's avatar
pixhawk committed
153
}