Homec4science
Diffusion HHRI-software (hri-gen3) Browse

R2671/CPP/HriPcController/mainwindow.cpp
0959a16c5548hri-gen3

Last Change
Raw File

mainwindow.cpp
View Options

#include "mainwindow.h"
#include "ui_mainwindow.h"
#include <QMessageBox>
#include <QDebug>
#include <QInputDialog>
#include <QList>
#include <QDateTime>
#include <limits>
#define GRAPH_UPDATE_PERIOD 50 ///< Plot window refresh period [ms].
/**
* @brief Constructor
* Setups the GUI, and try to connect to the HRI board.
* @param parent parent of this widget.
*/
MainWindow::MainWindow(QWidget *parent) :
QMainWindow(parent),
ui(new Ui::MainWindow)
{
//
ui->setupUi(this);
chart = new QtCharts::QChart();
ui->graphicsView->setChart(chart);
ui->graphicsView->setRenderHint(QPainter::Antialiasing);
graphUpdateTimer.setInterval(GRAPH_UPDATE_PERIOD);
graphUpdateTimer.setSingleShot(false);
connect(&graphUpdateTimer, SIGNAL(timeout()), this, SLOT(updateGraph()));
//
variablesListLayout = nullptr;
syncVars = nullptr;
// Ask for the COM port.
QString comPortName;
QStringList ports = HriBoard::getComPorts();
if(ports.size() == 0)
{
QMessageBox::critical(this, qApp->applicationName(), "No COM port.");
exit(0);
}
else if(ports.size() == 1)
comPortName = ports.first();
else
{
bool ok;
QString portChoice = QInputDialog::getItem(this,
qApp->applicationName(),
"Serial port:", ports, 0,
false, &ok);
int portIndex = ports.indexOf(portChoice);
if(portIndex == -1 || !ok)
exit(0);
comPortName = ports[portIndex];
}
//
connect(ui->logToFileCheckbox, SIGNAL(toggled(bool)),
this, SLOT(onLogToFileCheckboxToggled()));
// Establish the link with the HRI board.
hriBoard.openLink(comPortName);
connect(&hriBoard, SIGNAL(syncVarsListReceived(const QList<SyncVarBase*>&)),
this, SLOT(onVarsListReceived(const QList<SyncVarBase*>&)));
connect(&hriBoard, SIGNAL(syncVarUpdated(SyncVarBase*)),
this, SLOT(onVarUpdated(SyncVarBase*)));
}
/**
* @brief Destructor.
*/
MainWindow::~MainWindow()
{
delete ui;
}
/**
* @brief Displays the SyncVars list, and starts the streaming.
* @param syncVars SyncVars list.
* @remark This slot function is called automatically by the HriBoard object, as
* soon as the list is received from the board.
*/
void MainWindow::onVarsListReceived(const QList<SyncVarBase *> &syncVars)
{
this->syncVars = &syncVars;
// Populate the SyncVars list in the GUI.
QGridLayout* newLayout = new QGridLayout;
newLayout->setAlignment(Qt::AlignTop);
delete ui->scrollWidget->layout();
ui->scrollWidget->setLayout(newLayout);
if(variablesListLayout != nullptr)
variablesListLayout->deleteLater();
variablesListLayout = newLayout;
syncVarsWidgets.clear();
for(int i=0; i<syncVars.size(); i++)
{
SyncVarWidgetsLine varsWidgets;
// Name label.
varsWidgets.name = new QLabel(syncVars[i]->getName());
variablesListLayout->addWidget(varsWidgets.name, i, 0);
// Get button.
if(syncVars[i]->getAccess() != WRITEONLY)
{
varsWidgets.getButton = new QPushButton("Get");
variablesListLayout->addWidget(varsWidgets.getButton, i, 1);
connect(varsWidgets.getButton, SIGNAL(clicked(bool)),
this, SLOT(onGetButtonPressed()));
}
// Value field.
varsWidgets.valueSpinBox = new QDoubleSpinBox();
varsWidgets.valueSpinBox->setDecimals(4);
varsWidgets.valueSpinBox->setReadOnly(syncVars[i]->getAccess() == READONLY);
variablesListLayout->addWidget(varsWidgets.valueSpinBox, i, 2);
if(syncVars[i]->getAccess() != READONLY)
connect(varsWidgets.valueSpinBox, SIGNAL(editingFinished()),
this, SLOT(onSetButtonPressed()));
// Set button.
if(syncVars[i]->getAccess() != READONLY)
{
varsWidgets.setButton = new QPushButton("Set");
variablesListLayout->addWidget(varsWidgets.setButton, i, 3);
connect(varsWidgets.setButton, SIGNAL(clicked(bool)),
this, SLOT(onSetButtonPressed()));
}
// Stream checkbox.
if(syncVars[i]->getAccess() != WRITEONLY)
{
varsWidgets.streamCheckbox = new QCheckBox("Stream");
variablesListLayout->addWidget(varsWidgets.streamCheckbox, i, 4);
connect(varsWidgets.streamCheckbox, SIGNAL(toggled(bool)),
this, SLOT(onStreamCheckboxToggled()));
}
if(syncVars[i]->getAccess() != WRITEONLY)
{
varsWidgets.scaleSpinbox = new QDoubleSpinBox();
variablesListLayout->addWidget(varsWidgets.scaleSpinbox, i, 5);
varsWidgets.scaleSpinbox->setPrefix("x");
varsWidgets.scaleSpinbox->setValue(1.0);
varsWidgets.scaleSpinbox->setRange(-1000000.0, 1000000.0);
}
syncVarsWidgets.append(varsWidgets);
}
}
/**
* @brief Updates the "value" field of a SyncVar.
* @param var the SyncVar corresponding to the "value" field to update.
*/
void MainWindow::onVarUpdated(SyncVarBase *var)
{
int varIndex = syncVars->indexOf(var);
if(varIndex >= 0 && varIndex < syncVarsWidgets.size())
syncVarsWidgets[varIndex].valueSpinBox->setValue(var->toDouble());
}
/**
* @brief Gets the value of a SyncVar whose the "Get" button was pressed.
* @warning This function should only be called by the "Get" button signal.
*/
void MainWindow::onGetButtonPressed()
{
int varIndex = getVarIndexFromWidget((QWidget*)sender());
hriBoard.readRemoteVar(syncVars->at(varIndex));
}
/**
* @brief Sets the value of a SyncVar whose the "Set" button was pressed.
* @warning This function should only be called by the "Set" button signal.
*/
void MainWindow::onSetButtonPressed()
{
int varIndex = getVarIndexFromWidget((QWidget*)sender());
SyncVarBase *sv = syncVars->at(varIndex);
sv->fromDouble(syncVarsWidgets[varIndex].valueSpinBox->value());
hriBoard.writeRemoteVar(sv);
}
/**
* @brief Updates the list of SyncVars to stream from the checkboxes' states.
*/
void MainWindow::onStreamCheckboxToggled()
{
// Setup the streaming.
QList<SyncVarBase*> varsToStream;
for(int i=0; i<syncVarsWidgets.size(); i++)
{
if(syncVarsWidgets[i].streamCheckbox->isChecked())
varsToStream.append(syncVars->at(i));
}
hriBoard.setStreamedVars(varsToStream, &streamedVarsValuesBuffer);
// Setup the graph.
streamedVarsValuesBuffer.clear();
chart->removeAllSeries();
linesSeries.clear();
for(SyncVarBase *sv : varsToStream)
{
QtCharts::QLineSeries *series = new QtCharts::QLineSeries();
series->setName(sv->getName());
chart->addSeries(series);
linesSeries.append(series);
}
chart->createDefaultAxes();
chart->axisX()->setTitleText("Time [s]");
// Setup the update timer.
if(varsToStream.isEmpty())
graphUpdateTimer.stop();
else
graphUpdateTimer.start();
}
/**
* @brief Starts or stops the streamed variables logging to file.
*/
void MainWindow::onLogToFileCheckboxToggled()
{
if(ui->logToFileCheckbox->isChecked())
{
if(!hriBoard.startLoggingToFile())
{
QSignalBlocker signalBlocker(ui->logToFileCheckbox);
ui->logToFileCheckbox->setChecked(false);
}
}
else
hriBoard.stopLoggingToFile();
}
/**
* @brief Refreshes the plot frame.
*/
void MainWindow::updateGraph()
{
// Get the variables scales.
const QList<SyncVarBase*> &streamedVars = hriBoard.getStreamedVars();
QList<double> plotScales;
for(SyncVarBase* sv : streamedVars)
{
int varIndex = syncVars->indexOf(sv);
plotScales.append(syncVarsWidgets[varIndex].scaleSpinbox->value());
}
// Add the new points to the graph series.
int decimationCounter = 0;
while(!streamedVarsValuesBuffer.isEmpty())
{
if(decimationCounter <= 0)
{
decimationCounter = ui->plotDecimSpinbox->value();
QList<double> &values = streamedVarsValuesBuffer.first();
for(int i=0; i<linesSeries.size(); i++)
linesSeries[i]->append(values[0], values[i+1] * plotScales[i]);
}
else
decimationCounter--;
streamedVarsValuesBuffer.removeFirst();
}
// Remove the oldest points, to limit the number of points displayed.
for(QtCharts::QLineSeries *ls : linesSeries)
{
if(ls->count() > ui->nPointsSpinbox->value())
ls->removePoints(0, ls->count() - ui->nPointsSpinbox->value());
}
// Compute the display range.
if(linesSeries.size() > 0 && linesSeries.first()->count() > 0)
{
// Compute the horizontal (time) range.
double firstTime = linesSeries.first()->points().first().x();
double lastTime = linesSeries.first()->points().last().x();
chart->axisX()->setRange(firstTime, lastTime);
// Compute the vertical range.
double min = std::numeric_limits<double>::max();
double max = std::numeric_limits<double>::lowest();
for(QtCharts::QLineSeries *ls : linesSeries)
{
QVector<QPointF> points = ls->pointsVector();
for(QPointF p : points)
{
if(p.y() < min)
min = p.y();
if(p.y() > max)
max = p.y();
}
}
if(min == max)
{
min -= 1.0;
max += 1.0;
}
else
{
min -= (max-min) * 0.05; // Add a 5% margin at the top and the
max += (max-min) * 0.05; // bottom.
}
chart->axisY()->setRange(min, max);
}
}
/**
* @brief Gets the variable index from a widget of the SyncVars list.
* @param widget the widget belonging to the variables list.
* @return The index of the SyncVar corresponding to the given widget.
*/
int MainWindow::getVarIndexFromWidget(QWidget *widget)
{
int index = variablesListLayout->indexOf(widget);
int row, column, rowSpan, columnSpan;
variablesListLayout->getItemPosition(index, &row, &column,
&rowSpan, &columnSpan);
return row;
}
c4science · Help