YARP
Yet Another Robot Platform
 
Loading...
Searching...
No Matches
piddlg.cpp
Go to the documentation of this file.
1/*
2 * SPDX-FileCopyrightText: 2006-2021 Istituto Italiano di Tecnologia (IIT)
3 * SPDX-FileCopyrightText: 2006-2010 RobotCub Consortium
4 * SPDX-License-Identifier: LGPL-2.1-or-later
5 */
6
7#include "piddlg.h"
8#include "ui_piddlg.h"
9#include <QDebug>
10#include <QPushButton>
11#include <yarp/os/Bottle.h>
12#include <yarp/os/Value.h>
13
14#define TAB_POSITION 0
15#define TAB_POSITION_DIR 1
16#define TAB_VELOCITY 2
17#define TAB_VELOCITY_DIR 3
18#define TAB_MIXED 4
19#define TAB_TORQUE 5
20#define TAB_CURRENT 6
21#define TAB_MOTORPARAMS 7
22#define TAB_STIFF 8
23#define TAB_PWM 9
24#define TAB_VARIABLES 10
25
26#define POSITION_KP 0
27#define POSITION_KD 1
28#define POSITION_KI 2
29#define POSITION_SCALE 3
30#define POSITION_MAXOUTPUT 4
31#define POSITION_MAXINT 5
32#define POSITION_OFFSET 6
33#define POSITION_STICTIONUP 7
34#define POSITION_STICTIONDW 8
35#define POSITION_KFF 9
36
37#define POSITION_DIR_KP 0
38#define POSITION_DIR_KD 1
39#define POSITION_DIR_KI 2
40#define POSITION_DIR_SCALE 3
41#define POSITION_DIR_MAXOUTPUT 4
42#define POSITION_DIR_MAXINT 5
43#define POSITION_DIR_OFFSET 6
44#define POSITION_DIR_STICTIONUP 7
45#define POSITION_DIR_STICTIONDW 8
46#define POSITION_DIR_KFF 9
47
48#define VELOCITY_KP 0
49#define VELOCITY_KD 1
50#define VELOCITY_KI 2
51#define VELOCITY_SCALE 3
52#define VELOCITY_MAXOUTPUT 4
53#define VELOCITY_MAXINT 5
54#define VELOCITY_OFFSET 6
55#define VELOCITY_STICTIONUP 7
56#define VELOCITY_STICTIONDW 8
57#define VELOCITY_KFF 9
58
59#define VELOCITY_DIR_KP 0
60#define VELOCITY_DIR_KD 1
61#define VELOCITY_DIR_KI 2
62#define VELOCITY_DIR_SCALE 3
63#define VELOCITY_DIR_MAXOUTPUT 4
64#define VELOCITY_DIR_MAXINT 5
65#define VELOCITY_DIR_OFFSET 6
66#define VELOCITY_DIR_STICTIONUP 7
67#define VELOCITY_DIR_STICTIONDW 8
68#define VELOCITY_DIR_KFF 9
69
70#define MIXED_KP 0
71#define MIXED_KD 1
72#define MIXED_KI 2
73#define MIXED_SCALE 3
74#define MIXED_MAXOUTPUT 4
75#define MIXED_MAXINT 5
76#define MIXED_OFFSET 6
77#define MIXED_STICTIONUP 7
78#define MIXED_STICTIONDW 8
79#define MIXED_KFF 9
80
81#define TORQUE_KP 0
82#define TORQUE_KD 1
83#define TORQUE_KI 2
84#define TORQUE_SCALE 3
85#define TORQUE_MAXOUTPUT 4
86#define TORQUE_MAXINT 5
87#define TORQUE_OFFSET 6
88#define TORQUE_STITCTIONUP 7
89#define TORQUE_STICTIONDW 8
90#define TORQUE_KFF 9
91
92#define MOTOR_BEMFGAIN 0
93#define MOTOR_BEMFSCALE 1
94#define MOTOR_KTAUGAIN 2
95#define MOTOR_KTAUSCALE 3
96#define MOTOR_VISCOUSPOS 4
97#define MOTOR_VISCOUSNEG 5
98#define MOTOR_COULOMBPOS 6
99#define MOTOR_COULOMBNEG 7
100#define MOTOR_VELOCITY_THRESHOLD 8
101
102#define CURRENT_KP 0
103#define CURRENT_KD 1
104#define CURRENT_KI 2
105#define CURRENT_SCALE 3
106#define CURRENT_MAXOUTPUT 4
107#define CURRENT_MAXINT 5
108#define CURRENT_OFFSET 6
109#define CURRENT_KFF 7
110
111int getCurrentTabIndexByName(QTabWidget* tabWidget, const QString& name) {
112 for (int i = 0; i < tabWidget->count(); ++i) {
113 if (tabWidget->tabText(i) == name) {
114 return i;
115 }
116 }
117 return 0; // Default to first tab if not found
118}
119
120PidDlg::PidDlg(QString partname, int jointIndex, QString jointName, int cmode, QWidget *parent) :
121 QDialog(parent),
122 ui(new Ui::PidDlg)
123{
124 ui->setupUi(this);
125
126 //pos, posd, vel, veld, trq, cur, pwm
127 switch (cmode)
128 {
129 case 1:
130 ui->tabMain->setCurrentIndex(getCurrentTabIndexByName(ui->tabMain, "Position PID"));
131 break;
132 case 2:
133 ui->tabMain->setCurrentIndex(getCurrentTabIndexByName(ui->tabMain, "PositionDirect PID"));
134 break;
135 case 3:
136 ui->tabMain->setCurrentIndex(getCurrentTabIndexByName(ui->tabMain, "Mixed PID"));
137 break;
138 case 4:
139 ui->tabMain->setCurrentIndex(getCurrentTabIndexByName(ui->tabMain, "Velocity PID"));
140 break;
141 case 5:
142 ui->tabMain->setCurrentIndex(getCurrentTabIndexByName(ui->tabMain, "VelocityDirect PID"));
143 break;
144 case 6:
145 ui->tabMain->setCurrentIndex(getCurrentTabIndexByName(ui->tabMain, "Torque PID"));
146 break;
147 case 7:
148 ui->tabMain->setCurrentIndex(getCurrentTabIndexByName(ui->tabMain, "PWM Params"));
149 break;
150 case 8:
151 ui->tabMain->setCurrentIndex(getCurrentTabIndexByName(ui->tabMain, "Current PID"));
152 break;
153 default:
154 ui->tabMain->setCurrentIndex(0);
155 break;
156 }
157
158 this->jointIndex = jointIndex;
159
160 QString title = QString("Pid Control %1 JNT:%2 (%3)").arg(partname).arg(jointIndex).arg(jointName);
161 setWindowTitle(title);
162
163 connect(ui->btnRefresh, SIGNAL(clicked()), this, SLOT(onRefresh()));
164 connect(ui->btnSend,SIGNAL(clicked()),this,SLOT(onSend()));
165 connect(ui->btnCancel,SIGNAL(clicked()),this,SLOT(onCancel()));
166 connect(ui->btnDump, SIGNAL(clicked()), this, SLOT(onDumpRemoteVariables()));
167 connect(ui->selectPosition, SIGNAL(currentIndexChanged(int)), this, SLOT(onComboBoxIndexChangedPos(int)));
168 connect(ui->selectVelocity, SIGNAL(currentIndexChanged(int)), this, SLOT(onComboBoxIndexChangedVel(int)));
169 connect(ui->selectPositionDir, SIGNAL(currentIndexChanged(int)), this, SLOT(onComboBoxIndexChangedPosDir(int)));
170 connect(ui->selectVelocityDir, SIGNAL(currentIndexChanged(int)), this, SLOT(onComboBoxIndexChangedVelDir(int)));
171 connect(ui->selectTorque , SIGNAL(currentIndexChanged(int)), this, SLOT(onComboBoxIndexChangedTrq(int)));
172 connect(ui->selectCurrent, SIGNAL(currentIndexChanged(int)), this, SLOT(onComboBoxIndexChangedCur(int)));
173
174 connect(ui->tableStiffness, &QTableWidget::itemChanged, this, [this](QTableWidgetItem* item)
175 {
176 if (item == ui->tableStiffness->item(2, 3))
177 {
178 onForceOffsetChanged(item->text());
179 }
180 });
181
182 ui->tablePosition->setItemDelegate(new TableDoubleDelegate);
183 ui->tableVelocity->setItemDelegate(new TableDoubleDelegate);
184 ui->tablePositionDir->setItemDelegate(new TableDoubleDelegate);
185 ui->tableVelocityDir->setItemDelegate(new TableDoubleDelegate);
186 ui->tableTorque->setItemDelegate(new TableDoubleDelegate);
187 ui->tableStiffness->setItemDelegate(new TableDoubleDelegate);
188 ui->tablePWM->setItemDelegate(new TableDoubleDelegate);
189 ui->tableCurrent->setItemDelegate(new TableDoubleDelegate);
190 ui->tableCurrent->setItemDelegate(new TableGenericDelegate);
191}
192
193void PidDlg::onForceOffsetChanged(QString forceOffset)
194{
195 forceOffsetChanged = true;
196}
197
198void PidDlg::onDumpRemoteVariables()
199{
200 emit dumpRemoteVariables();
201}
202
204{
205 for (auto& button : buttons)
206 {
207 delete button;
208 button = nullptr;
209 }
210 buttons.clear();
211 delete ui;
212}
213
214std::string prepareDescription(const PidWithExtraInfo& myPid)
215{
216 return "Description: " + myPid.pidExtraInfo.description.pid_description + "\n" +
217 "Input: " + myPid.pidExtraInfo.description.input_data_description + "\n" +
219}
220
221void PidDlg::initPositionPID(const std::vector<PidWithExtraInfo>& myPids)
222{
223 size_t pidindex = ui->selectPosition->currentIndex();
224 std::string desc = prepareDescription(myPids[pidindex]);
225 ui->descPosition->setText(QString("%1").arg(desc.c_str()));
226
227 ui->tablePosition->item(POSITION_KP,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
228 ui->tablePosition->item(POSITION_KP,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
229
230 ui->tablePosition->item(POSITION_KD,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
231 ui->tablePosition->item(POSITION_KD,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
232
233 ui->tablePosition->item(POSITION_KI,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
234 ui->tablePosition->item(POSITION_KI,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
235
236 ui->tablePosition->item(POSITION_SCALE,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
237 ui->tablePosition->item(POSITION_SCALE,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
238
239 ui->tablePosition->item(POSITION_OFFSET,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
240 ui->tablePosition->item(POSITION_OFFSET,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
241
242 ui->tablePosition->item(POSITION_STICTIONUP,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
243 ui->tablePosition->item(POSITION_STICTIONUP,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
244
245 ui->tablePosition->item(POSITION_MAXOUTPUT,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
246 ui->tablePosition->item(POSITION_MAXOUTPUT,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
247
248 ui->tablePosition->item(POSITION_STICTIONDW,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
249 ui->tablePosition->item(POSITION_STICTIONDW,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
250
251 ui->tablePosition->item(POSITION_MAXINT,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
252 ui->tablePosition->item(POSITION_MAXINT,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
253
254 ui->tablePosition->item(POSITION_KFF,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
255 ui->tablePosition->item(POSITION_KFF,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
256}
257
258void PidDlg::initPositionDirectPID(const std::vector<PidWithExtraInfo>& myPids)
259{
260 size_t pidindex = ui->selectPositionDir->currentIndex();
261 std::string desc = prepareDescription(myPids[pidindex]);
262 ui->descPositionDir->setText(QString("%1").arg(desc.c_str()));
263
264 ui->tablePositionDir->item(POSITION_DIR_KP,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
265 ui->tablePositionDir->item(POSITION_DIR_KP,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
266
267 ui->tablePositionDir->item(POSITION_DIR_KD,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
268 ui->tablePositionDir->item(POSITION_DIR_KD,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
269
270 ui->tablePositionDir->item(POSITION_DIR_KI,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
271 ui->tablePositionDir->item(POSITION_DIR_KI,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
272
273 ui->tablePositionDir->item(POSITION_DIR_SCALE,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
274 ui->tablePositionDir->item(POSITION_DIR_SCALE,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
275
276 ui->tablePositionDir->item(POSITION_DIR_OFFSET,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
277 ui->tablePositionDir->item(POSITION_DIR_OFFSET,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
278
279 ui->tablePositionDir->item(POSITION_DIR_STICTIONUP,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
280 ui->tablePositionDir->item(POSITION_DIR_STICTIONUP,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
281
282 ui->tablePositionDir->item(POSITION_DIR_MAXOUTPUT,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
283 ui->tablePositionDir->item(POSITION_DIR_MAXOUTPUT,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
284
285 ui->tablePositionDir->item(POSITION_DIR_STICTIONDW,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
286 ui->tablePositionDir->item(POSITION_DIR_STICTIONDW,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
287
288 ui->tablePositionDir->item(POSITION_DIR_MAXINT,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
289 ui->tablePositionDir->item(POSITION_DIR_MAXINT,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
290
291 ui->tablePositionDir->item(POSITION_DIR_KFF,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
292 ui->tablePositionDir->item(POSITION_DIR_KFF,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
293}
294
295void PidDlg::initVelocityPID(const std::vector<PidWithExtraInfo>& myPids)
296{
297 size_t pidindex = ui->selectVelocity->currentIndex();
298 std::string desc = prepareDescription(myPids[pidindex]);
299 ui->descVelocity->setText(QString("%1").arg(desc.c_str()));
300
301 ui->tableVelocity->item(VELOCITY_KP, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
302 ui->tableVelocity->item(VELOCITY_KP, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
303
304 ui->tableVelocity->item(VELOCITY_KD, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
305 ui->tableVelocity->item(VELOCITY_KD, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
306
307 ui->tableVelocity->item(VELOCITY_KI, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
308 ui->tableVelocity->item(VELOCITY_KI, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
309
310 ui->tableVelocity->item(VELOCITY_SCALE, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
311 ui->tableVelocity->item(VELOCITY_SCALE, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
312
313 ui->tableVelocity->item(VELOCITY_OFFSET, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
314 ui->tableVelocity->item(VELOCITY_OFFSET, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
315
316 ui->tableVelocity->item(VELOCITY_STICTIONUP, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
317 ui->tableVelocity->item(VELOCITY_STICTIONUP, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
318
319 ui->tableVelocity->item(VELOCITY_MAXOUTPUT, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
320 ui->tableVelocity->item(VELOCITY_MAXOUTPUT, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
321
322 ui->tableVelocity->item(VELOCITY_STICTIONDW, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
323 ui->tableVelocity->item(VELOCITY_STICTIONDW, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
324
325 ui->tableVelocity->item(VELOCITY_MAXINT, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
326 ui->tableVelocity->item(VELOCITY_MAXINT, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
327
328 ui->tableVelocity->item(VELOCITY_KFF,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
329 ui->tableVelocity->item(VELOCITY_KFF,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
330}
331
332void PidDlg::initVelocityDirectPID(const std::vector<PidWithExtraInfo>& myPids)
333{
334 size_t pidindex = ui->selectVelocityDir->currentIndex();
335 std::string desc = prepareDescription(myPids[pidindex]);
336 ui->descVelocityDir->setText(QString("%1").arg(desc.c_str()));
337
338 ui->tableVelocityDir->item(VELOCITY_DIR_KP, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
339 ui->tableVelocityDir->item(VELOCITY_DIR_KP, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
340
341 ui->tableVelocityDir->item(VELOCITY_DIR_KD, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
342 ui->tableVelocityDir->item(VELOCITY_DIR_KD, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
343
344 ui->tableVelocityDir->item(VELOCITY_DIR_KI, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
345 ui->tableVelocityDir->item(VELOCITY_DIR_KI, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
346
347 ui->tableVelocityDir->item(VELOCITY_DIR_SCALE, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
348 ui->tableVelocityDir->item(VELOCITY_DIR_SCALE, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
349
350 ui->tableVelocityDir->item(VELOCITY_DIR_OFFSET, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
351 ui->tableVelocityDir->item(VELOCITY_DIR_OFFSET, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
352
353 ui->tableVelocityDir->item(VELOCITY_DIR_STICTIONUP, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
354 ui->tableVelocityDir->item(VELOCITY_DIR_STICTIONUP, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
355
356 ui->tableVelocityDir->item(VELOCITY_DIR_MAXOUTPUT, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
357 ui->tableVelocityDir->item(VELOCITY_DIR_MAXOUTPUT, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
358
359 ui->tableVelocityDir->item(VELOCITY_DIR_STICTIONDW, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
360 ui->tableVelocityDir->item(VELOCITY_DIR_STICTIONDW, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
361
362 ui->tableVelocityDir->item(VELOCITY_DIR_MAXINT, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
363 ui->tableVelocityDir->item(VELOCITY_DIR_MAXINT, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
364
365 ui->tableVelocityDir->item(VELOCITY_DIR_KFF,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
366 ui->tableVelocityDir->item(VELOCITY_DIR_KFF,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
367}
368
369void PidDlg::initMixedPID(const std::vector<PidWithExtraInfo>& myPids)
370{
371 size_t pidindex = ui->selectMixed->currentIndex();
372 std::string desc = prepareDescription(myPids[pidindex]);
373 ui->descMixed->setText(QString("%1").arg(desc.c_str()));
374
375 ui->tableMixed->item(MIXED_KP, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
376 ui->tableMixed->item(MIXED_KP, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
377
378 ui->tableMixed->item(MIXED_KD, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
379 ui->tableMixed->item(MIXED_KD, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
380
381 ui->tableMixed->item(MIXED_KI, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
382 ui->tableMixed->item(MIXED_KI, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
383
384 ui->tableMixed->item(MIXED_SCALE, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
385 ui->tableMixed->item(MIXED_SCALE, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
386
387 ui->tableMixed->item(MIXED_OFFSET, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
388 ui->tableMixed->item(MIXED_OFFSET, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
389
390 ui->tableMixed->item(MIXED_STICTIONUP, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
391 ui->tableMixed->item(MIXED_STICTIONUP, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
392
393 ui->tableMixed->item(MIXED_MAXOUTPUT, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
394 ui->tableMixed->item(MIXED_MAXOUTPUT, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
395
396 ui->tableMixed->item(MIXED_STICTIONDW, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
397 ui->tableMixed->item(MIXED_STICTIONDW, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
398
399 ui->tableMixed->item(MIXED_MAXINT, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
400 ui->tableMixed->item(MIXED_MAXINT, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
401
402 ui->tableMixed->item(MIXED_KFF,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
403 ui->tableMixed->item(MIXED_KFF,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
404}
405
406void PidDlg::initTorquePID(const std::vector<PidWithExtraInfo>& myPids)
407{
408 size_t pidindex = ui->selectTorque->currentIndex();
409 std::string desc = prepareDescription(myPids[pidindex]);
410 ui->descTorque->setText(QString("%1").arg(desc.c_str()));
411
412 ui->tableTorque->item(TORQUE_KP,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
413 ui->tableTorque->item(TORQUE_KP,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
414
415 ui->tableTorque->item(TORQUE_KD,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
416 ui->tableTorque->item(TORQUE_KD,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
417
418 ui->tableTorque->item(TORQUE_KI,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
419 ui->tableTorque->item(TORQUE_KI,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
420
421 ui->tableTorque->item(TORQUE_SCALE,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
422 ui->tableTorque->item(TORQUE_SCALE,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
423
424 ui->tableTorque->item(TORQUE_OFFSET,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
425 ui->tableTorque->item(TORQUE_OFFSET,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
426
427 ui->tableTorque->item(TORQUE_STITCTIONUP,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
428 ui->tableTorque->item(TORQUE_STITCTIONUP,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_up_val));
429
430 ui->tableTorque->item(TORQUE_MAXOUTPUT,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
431 ui->tableTorque->item(TORQUE_MAXOUTPUT,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
432
433 ui->tableTorque->item(TORQUE_STICTIONDW,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
434 ui->tableTorque->item(TORQUE_STICTIONDW,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.stiction_down_val));
435
436 ui->tableTorque->item(TORQUE_MAXINT,0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
437 ui->tableTorque->item(TORQUE_MAXINT,1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
438
439 ui->tableTorque->item(TORQUE_KFF,0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
440 ui->tableTorque->item(TORQUE_KFF,1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
441}
442
444{
445 ui->tableMotorParams->item(MOTOR_BEMFGAIN,0)->setText(QString("%1").arg((double)MotParam.bemf));
446 ui->tableMotorParams->item(MOTOR_BEMFGAIN,1)->setText(QString("%1").arg((double)MotParam.bemf));
447
448 ui->tableMotorParams->item(MOTOR_BEMFSCALE,0)->setText(QString("%1").arg((int)MotParam.bemf_scale));
449 ui->tableMotorParams->item(MOTOR_BEMFSCALE,1)->setText(QString("%1").arg((int)MotParam.bemf_scale));
450
451 ui->tableMotorParams->item(MOTOR_KTAUGAIN,0)->setText(QString("%1").arg((double)MotParam.ktau));
452 ui->tableMotorParams->item(MOTOR_KTAUGAIN,1)->setText(QString("%1").arg((double)MotParam.ktau));
453
454 ui->tableMotorParams->item(MOTOR_KTAUSCALE,0)->setText(QString("%1").arg((int)MotParam.ktau_scale));
455 ui->tableMotorParams->item(MOTOR_KTAUSCALE,1)->setText(QString("%1").arg((int)MotParam.ktau_scale));
456
457 ui->tableMotorParams->item(MOTOR_VISCOUSPOS, 0)->setText(QString("%1").arg((double)MotParam.viscousPos));
458 ui->tableMotorParams->item(MOTOR_VISCOUSPOS, 1)->setText(QString("%1").arg((double)MotParam.viscousPos));
459 ui->tableMotorParams->item(MOTOR_VISCOUSNEG, 0)->setText(QString("%1").arg((double)MotParam.viscousNeg));
460 ui->tableMotorParams->item(MOTOR_VISCOUSNEG, 1)->setText(QString("%1").arg((double)MotParam.viscousNeg));
461
462 ui->tableMotorParams->item(MOTOR_COULOMBPOS, 0)->setText(QString("%1").arg((double)MotParam.coulombPos));
463 ui->tableMotorParams->item(MOTOR_COULOMBPOS, 1)->setText(QString("%1").arg((double)MotParam.coulombPos));
464 ui->tableMotorParams->item(MOTOR_COULOMBNEG, 0)->setText(QString("%1").arg((double)MotParam.coulombNeg));
465 ui->tableMotorParams->item(MOTOR_COULOMBNEG, 1)->setText(QString("%1").arg((double)MotParam.coulombNeg));
466
467 ui->tableMotorParams->item(MOTOR_VELOCITY_THRESHOLD, 0)->setText(QString("%1").arg((double)MotParam.velocityThres));
468 ui->tableMotorParams->item(MOTOR_VELOCITY_THRESHOLD, 1)->setText(QString("%1").arg((double)MotParam.velocityThres));
469}
470
471void PidDlg::onSendRemoteVariable()
472{
473 int i = -1;
474 for (size_t elem = 0; elem < buttons.size(); elem++)
475 {
476 if (sender() == buttons[elem])
477 {
478 i = elem;
479 break;
480 }
481 }
482 if (i == -1) {
483 return;
484 }
485
486 std::string key = ui->tableVariables->item(i, 0)->text().toStdString();
487 std::string val = ui->tableVariables->item(i, 1)->text().toStdString();
488 yarp::os::Bottle valb(val);
489 emit sendSingleRemoteVariable(key, valb);
491}
492
494{
495 // Remote Variables
496 if (iVar)
497 {
498 ui->tableVariables->clear();
499 ui->tableVariables->clearContents();
500 ui->tableVariables->setRowCount(0);
501 ui->tableVariables->setColumnCount(0);
502 ui->tableVariables->insertColumn(0);
503 ui->tableVariables->insertColumn(0);
504 ui->tableVariables->insertColumn(0);
505 ui->tableVariables->setMinimumWidth(500);
506 ui->tableVariables->setHorizontalHeaderItem(0, new QTableWidgetItem(QString("Key")));
507 ui->tableVariables->setHorizontalHeaderItem(1, new QTableWidgetItem(QString("Values")));
508 ui->tableVariables->setHorizontalHeaderItem(2, new QTableWidgetItem(QString("")));
509
510 yarp::os::Bottle keys;
511 if (iVar->getRemoteVariablesList(&keys))
512 {
513 std::string s = keys.toString();
514 int keys_size = keys.size();
515 for (auto& button : buttons)
516 {
517 delete button;
518 button = nullptr;
519 }
520 buttons.clear();
521 buttons.resize(keys_size);
522
523 for (int i = 0; i < keys_size; i++)
524 {
525 buttons[i] = new QPushButton("Send");
526 connect(buttons[i], SIGNAL(clicked()), this, SLOT(onSendRemoteVariable()));
527
528 std::string v;
529 if (keys.get(i).isString())
530 {
532 v = keys.get(i).asString();
533 iVar->getRemoteVariable(v, val);
534 ui->tableVariables->insertRow(i);
535 ui->tableVariables->setItem(i, 0, new QTableWidgetItem(QString(v.c_str())));
536 ui->tableVariables->item(i, 0)->setFlags(Qt::NoItemFlags);
537 ui->tableVariables->setItem(i, 1, new QTableWidgetItem(QString(val.toString().c_str())));
538 ui->tableVariables->item(i, 1)->setFlags(Qt::ItemIsEditable | Qt::ItemIsEnabled );
539 ui->tableVariables->setColumnWidth(1, 500);
540 ui->tableVariables->setCellWidget(i, 2, (QWidget*)buttons[i]);
541
542 /*yarp::os::Bottle val;
543 v = keys.get(i).asString();
544 iVar->getRemoteVariable(v, val);
545 int valsize = val.get(0).size();
546 ui->tableVariables->insertRow(i);
547 ui->tableVariables->setItem(i, 0, new QTableWidgetItem(QString(v.c_str())));
548 ui->tableVariables->item(i, 0)->setFlags(Qt::NoItemFlags);
549 for (int j = 0; j < valsize; j++)
550 {
551 ui->tableVariables->setItem(i, j+1, new QTableWidgetItem(QString(val.get(j).toString().c_str())));
552 }*/
553 }
554 }
555 }
556 }
557}
558
559void PidDlg::initStiffness(double curStiffVal, double minStiff, double maxStiff,
560 double curDampVal, double minDamp, double maxDamp)
561{
562 ui->tableStiffness->item(0,0)->setText(QString("%L1").arg(curStiffVal,0,'f',3));
563 ui->tableStiffness->item(0,1)->setText(QString("%L1").arg(minStiff,0,'f',3));
564 ui->tableStiffness->item(0,2)->setText(QString("%L1").arg(maxStiff,0,'f',3));
565 ui->tableStiffness->item(0,3)->setText(QString("%L1").arg(curStiffVal,0,'f',3));
566
567 ui->tableStiffness->item(1,0)->setText(QString("%L1").arg(curDampVal,0,'f',3));
568 ui->tableStiffness->item(1,1)->setText(QString("%L1").arg(minDamp,0,'f',3));
569 ui->tableStiffness->item(1,2)->setText(QString("%L1").arg(maxDamp,0,'f',3));
570 ui->tableStiffness->item(1,3)->setText(QString("%L1").arg(curDampVal,0,'f',3));
571}
572
573void PidDlg::initTorqueOffset(double curForceVal, double minForce, double maxForce)
574{
575 ui->tableStiffness->item(2,0)->setText(QString("%L1").arg(curForceVal,0,'f',3));
576 ui->tableStiffness->item(2,1)->setText(QString("%L1").arg(minForce,0,'f',3));
577 ui->tableStiffness->item(2,2)->setText(QString("%L1").arg(maxForce,0,'f',3));
578 ui->tableStiffness->item(2,3)->setText(QString("%L1").arg(curForceVal,0,'f',3));
579 forceOffsetChanged=false;
580}
581
582
583void PidDlg::initPWM(double PWMVal, double pwm)
584{
585 ui->tablePWM->item(0, 0)->setText(QString("%1").arg((double)PWMVal));
586 ui->tablePWM->item(0, 1)->setText(QString("%1").arg((double)PWMVal));
587
588 ui->tablePWM->item(1,0)->setText(QString("%1").arg(pwm));
589}
590
591void PidDlg::initCurrentPID(const std::vector<PidWithExtraInfo>& myPids)
592{
593 size_t pidindex = ui->selectCurrent->currentIndex();
594 std::string desc = prepareDescription(myPids[pidindex]);
595 ui->descCurrent->setText(QString("%1").arg(desc.c_str()));
596
597 ui->tableCurrent->item(CURRENT_KP, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
598 ui->tableCurrent->item(CURRENT_KP, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kp));
599
600 ui->tableCurrent->item(CURRENT_KD, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
601 ui->tableCurrent->item(CURRENT_KD, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kd));
602
603 ui->tableCurrent->item(CURRENT_KI, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
604 ui->tableCurrent->item(CURRENT_KI, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.ki));
605
606 ui->tableCurrent->item(CURRENT_SCALE, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
607 ui->tableCurrent->item(CURRENT_SCALE, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.scale));
608
609 ui->tableCurrent->item(CURRENT_MAXOUTPUT, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
610 ui->tableCurrent->item(CURRENT_MAXOUTPUT, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_output));
611
612 ui->tableCurrent->item(CURRENT_MAXINT, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
613 ui->tableCurrent->item(CURRENT_MAXINT, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.max_int));
614
615 ui->tableCurrent->item(CURRENT_OFFSET, 0)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
616 ui->tableCurrent->item(CURRENT_OFFSET, 1)->setText(QString("%1").arg((int)myPids[pidindex].pid.offset));
617
618 ui->tableCurrent->item(CURRENT_KFF, 0)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
619 ui->tableCurrent->item(CURRENT_KFF, 1)->setText(QString("%1").arg((double)myPids[pidindex].pid.kff));
620}
621
622void PidDlg::onRefresh()
623{
624 emit refreshPids(jointIndex);
625}
626
627void PidDlg::onComboBoxIndexChangedPos(int selection)
628{
629 emit refreshPids(jointIndex);
630}
631void PidDlg::onComboBoxIndexChangedVel(int selection)
632{
633 emit refreshPids(jointIndex);
634}
635void PidDlg::onComboBoxIndexChangedPosDir(int selection)
636{
637 emit refreshPids(jointIndex);
638}
639void PidDlg::onComboBoxIndexChangedVelDir(int selection)
640{
641 emit refreshPids(jointIndex);
642}
643void PidDlg::onComboBoxIndexChangedMix(int selection)
644{
645 emit refreshPids(jointIndex);
646}
647void PidDlg::onComboBoxIndexChangedTrq(int selection)
648{
649 emit refreshPids(jointIndex);
650}
651void PidDlg::onComboBoxIndexChangedCur(int selection)
652{
653 emit refreshPids(jointIndex);
654}
655
656
658{
659 std::string pidtyped = yarp::os::Vocab32::decode((yarp::conf::vocab32_t)base);
660 pidtyped[3] = index +'0';
662 return val;
663}
664
665void PidDlg::onSend()
666{
667 Pid newPid;
668 MotorTorqueParameters newMotorTorqueParams;
669 PidControlTypeEnum pidtype;
670 int combo_selection=0;
671
672 switch (ui->tabMain->currentIndex()) {
673 case TAB_POSITION:
674 combo_selection = ui->selectPosition->currentIndex();
675 pidtype = choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_POSITION, combo_selection+1);
676 newPid.kp = ui->tablePosition->item(POSITION_KP,1)->text().toDouble();
677 newPid.kd = ui->tablePosition->item(POSITION_KD,1)->text().toDouble();
678 newPid.ki = ui->tablePosition->item(POSITION_KI,1)->text().toDouble();
679 newPid.kff = ui->tablePosition->item(POSITION_KFF,1)->text().toDouble();
680 newPid.scale = ui->tablePosition->item(POSITION_SCALE,1)->text().toDouble();
681 newPid.offset = ui->tablePosition->item(POSITION_OFFSET,1)->text().toDouble();
682 newPid.stiction_up_val = ui->tablePosition->item(POSITION_STICTIONUP,1)->text().toDouble();
683 newPid.max_output = ui->tablePosition->item(POSITION_MAXOUTPUT,1)->text().toDouble();
684 newPid.stiction_down_val = ui->tablePosition->item(POSITION_STICTIONDW,1)->text().toDouble();
685 newPid.max_int = ui->tablePosition->item(POSITION_MAXINT,1)->text().toDouble();
686 emit sendPid(pidtype, jointIndex,newPid);
687 break;
688 case TAB_POSITION_DIR:
689 combo_selection = ui->selectPositionDir->currentIndex();
690 pidtype = choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_POSITION_DIRECT, combo_selection+1);
691 newPid.kp = ui->tablePositionDir->item(POSITION_DIR_KP,1)->text().toDouble();
692 newPid.kd = ui->tablePositionDir->item(POSITION_DIR_KD,1)->text().toDouble();
693 newPid.ki = ui->tablePositionDir->item(POSITION_DIR_KI,1)->text().toDouble();
694 newPid.kff = ui->tablePositionDir->item(POSITION_DIR_KFF, 1)->text().toDouble();
695 newPid.scale = ui->tablePositionDir->item(POSITION_DIR_SCALE,1)->text().toDouble();
696 newPid.offset = ui->tablePositionDir->item(POSITION_DIR_OFFSET,1)->text().toDouble();
697 newPid.stiction_up_val = ui->tablePositionDir->item(POSITION_DIR_STICTIONUP,1)->text().toDouble();
698 newPid.max_output = ui->tablePositionDir->item(POSITION_DIR_MAXOUTPUT,1)->text().toDouble();
699 newPid.stiction_down_val = ui->tablePositionDir->item(POSITION_DIR_STICTIONDW,1)->text().toDouble();
700 newPid.max_int = ui->tablePositionDir->item(POSITION_DIR_MAXINT,1)->text().toDouble();
701 emit sendPid(pidtype, jointIndex,newPid);
702 break;
703 case TAB_VELOCITY:
704 combo_selection = ui->selectVelocity->currentIndex();
705 pidtype = choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_VELOCITY, combo_selection+1);
706 newPid.kp = ui->tableVelocity->item(VELOCITY_KP, 1)->text().toDouble();
707 newPid.kd = ui->tableVelocity->item(VELOCITY_KD, 1)->text().toDouble();
708 newPid.ki = ui->tableVelocity->item(VELOCITY_KI, 1)->text().toDouble();
709 newPid.kff = ui->tableVelocity->item(VELOCITY_KFF, 1)->text().toDouble();
710 newPid.scale = ui->tableVelocity->item(VELOCITY_SCALE, 1)->text().toDouble();
711 newPid.offset = ui->tableVelocity->item(VELOCITY_OFFSET, 1)->text().toDouble();
712 newPid.stiction_up_val = ui->tableVelocity->item(VELOCITY_STICTIONUP, 1)->text().toDouble();
713 newPid.max_output = ui->tableVelocity->item(VELOCITY_MAXOUTPUT, 1)->text().toDouble();
714 newPid.stiction_down_val = ui->tableVelocity->item(VELOCITY_STICTIONDW, 1)->text().toDouble();
715 newPid.max_int = ui->tableVelocity->item(VELOCITY_MAXINT, 1)->text().toDouble();
716 emit sendPid(pidtype, jointIndex, newPid);
717 break;
718 case TAB_VELOCITY_DIR:
719 combo_selection = ui->selectVelocityDir->currentIndex();
720 pidtype = choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_VELOCITY_DIRECT, combo_selection+1);
721 newPid.kp = ui->tableVelocityDir->item(VELOCITY_DIR_KP, 1)->text().toDouble();
722 newPid.kd = ui->tableVelocityDir->item(VELOCITY_DIR_KD, 1)->text().toDouble();
723 newPid.ki = ui->tableVelocityDir->item(VELOCITY_DIR_KI, 1)->text().toDouble();
724 newPid.kff = ui->tableVelocityDir->item(VELOCITY_DIR_KFF,1)->text().toDouble();
725 newPid.scale = ui->tableVelocityDir->item(VELOCITY_DIR_SCALE, 1)->text().toDouble();
726 newPid.offset = ui->tableVelocityDir->item(VELOCITY_DIR_OFFSET, 1)->text().toDouble();
727 newPid.stiction_up_val = ui->tableVelocityDir->item(VELOCITY_DIR_STICTIONUP, 1)->text().toDouble();
728 newPid.max_output = ui->tableVelocityDir->item(VELOCITY_DIR_MAXOUTPUT, 1)->text().toDouble();
729 newPid.stiction_down_val = ui->tableVelocityDir->item(VELOCITY_DIR_STICTIONDW, 1)->text().toDouble();
730 newPid.max_int = ui->tableVelocityDir->item(VELOCITY_DIR_MAXINT, 1)->text().toDouble();
731 emit sendPid(pidtype, jointIndex, newPid);
732 break;
733 case TAB_MIXED:
734 combo_selection = ui->selectMixed->currentIndex();
735 pidtype = choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_MIXED, combo_selection+1);
736 newPid.kp = ui->tableMixed->item(MIXED_KP, 1)->text().toDouble();
737 newPid.kd = ui->tableMixed->item(MIXED_KD, 1)->text().toDouble();
738 newPid.ki = ui->tableMixed->item(MIXED_KI, 1)->text().toDouble();
739 newPid.kff = ui->tableMixed->item(MIXED_KFF,1)->text().toDouble();
740 newPid.scale = ui->tableMixed->item(MIXED_SCALE, 1)->text().toDouble();
741 newPid.offset = ui->tableMixed->item(MIXED_OFFSET, 1)->text().toDouble();
742 newPid.stiction_up_val = ui->tableMixed->item(MIXED_STICTIONUP, 1)->text().toDouble();
743 newPid.max_output = ui->tableMixed->item(MIXED_MAXOUTPUT, 1)->text().toDouble();
744 newPid.stiction_down_val = ui->tableMixed->item(MIXED_STICTIONDW, 1)->text().toDouble();
745 newPid.max_int = ui->tableMixed->item(MIXED_MAXINT, 1)->text().toDouble();
746 emit sendPid(pidtype, jointIndex, newPid);
747 break;
748 case TAB_TORQUE:
749 combo_selection = ui->selectTorque->currentIndex();
750 pidtype = choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_TORQUE, combo_selection+1);
751 newPid.kp = ui->tableTorque->item(TORQUE_KP,1)->text().toDouble();
752 newPid.kd = ui->tableTorque->item(TORQUE_KD,1)->text().toDouble();
753 newPid.ki = ui->tableTorque->item(TORQUE_KI,1)->text().toDouble();
754 newPid.kff = ui->tableTorque->item(TORQUE_KFF,1)->text().toDouble();
755 newPid.scale = ui->tableTorque->item(TORQUE_SCALE,1)->text().toDouble();
756 newPid.offset = ui->tableTorque->item(TORQUE_OFFSET,1)->text().toDouble();
757 newPid.stiction_up_val = ui->tableTorque->item(TORQUE_STITCTIONUP,1)->text().toDouble();
758 newPid.max_output = ui->tableTorque->item(TORQUE_MAXOUTPUT,1)->text().toDouble();
759 newPid.stiction_down_val = ui->tableTorque->item(TORQUE_STICTIONDW,1)->text().toDouble();
760 newPid.max_int = ui->tableTorque->item(TORQUE_MAXINT,1)->text().toDouble();
761 emit sendPid(pidtype, jointIndex,newPid);
762 break;
763 case TAB_CURRENT:{
764 combo_selection = ui->selectCurrent->currentIndex();
765 pidtype = choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_CURRENT, combo_selection+1);
766 newPid.kp = ui->tableCurrent->item(CURRENT_KP, 1)->text().toDouble();
767 newPid.kd = ui->tableCurrent->item(CURRENT_KD, 1)->text().toDouble();
768 newPid.ki = ui->tableCurrent->item(CURRENT_KI, 1)->text().toDouble();
769 newPid.kff = ui->tableCurrent->item(CURRENT_KFF,1)->text().toDouble();
770 newPid.scale = ui->tableCurrent->item(CURRENT_SCALE, 1)->text().toDouble();
771 newPid.offset = ui->tableCurrent->item(CURRENT_OFFSET, 1)->text().toDouble();
772 newPid.max_output = ui->tableCurrent->item(CURRENT_MAXOUTPUT, 1)->text().toDouble();
773 newPid.max_int = ui->tableCurrent->item(CURRENT_MAXINT, 1)->text().toDouble();
774 emit sendPid(pidtype, jointIndex, newPid);
775 break;
776 }
777 case TAB_MOTORPARAMS:
778 newMotorTorqueParams.bemf = ui->tableMotorParams->item(MOTOR_BEMFGAIN,1)->text().toDouble();
779 newMotorTorqueParams.bemf_scale = ui->tableMotorParams->item(MOTOR_BEMFSCALE,1)->text().toDouble();
780 newMotorTorqueParams.ktau = ui->tableMotorParams->item(MOTOR_KTAUGAIN,1)->text().toDouble();
781 newMotorTorqueParams.ktau_scale = ui->tableMotorParams->item(MOTOR_KTAUSCALE,1)->text().toDouble();
782 newMotorTorqueParams.viscousPos = ui->tableMotorParams->item(MOTOR_VISCOUSPOS,1)->text().toDouble();
783 newMotorTorqueParams.viscousNeg = ui->tableMotorParams->item(MOTOR_VISCOUSNEG,1)->text().toDouble();
784 newMotorTorqueParams.coulombPos = ui->tableMotorParams->item(MOTOR_COULOMBPOS,1)->text().toDouble();
785 newMotorTorqueParams.coulombNeg = ui->tableMotorParams->item(MOTOR_COULOMBNEG,1)->text().toDouble();
786 newMotorTorqueParams.velocityThres = ui->tableMotorParams->item(MOTOR_VELOCITY_THRESHOLD,1)->text().toDouble();
787 emit sendMotorParameters(jointIndex,newMotorTorqueParams);
788 break;
789 case TAB_STIFF:{
790 double desiredStiff = ui->tableStiffness->item(0,3)->text().toDouble();
791 double desiredDamp = ui->tableStiffness->item(1,3)->text().toDouble();
792 double desiredForce = ui->tableStiffness->item(2,3)->text().toDouble();
793 emit sendStiffness(jointIndex,desiredStiff,desiredDamp);
794 if (forceOffsetChanged)
795 {
796 emit sendForceOffset(jointIndex, desiredForce);
797 forceOffsetChanged = false;
798 }
799 break;
800 }
801 case TAB_PWM:{
802 int desiredDuty = ui->tablePWM->item(0,1)->text().toDouble();
803 emit sendPWM(jointIndex,desiredDuty);
804 break;
805 }
806 case TAB_VARIABLES:{
807 // Remote Variables
808 int rows = ui->tableVariables->rowCount();
809 for (int i = 0; i < rows; i++)
810 {
811 std::string key = ui->tableVariables->item(i, 0)->text().toStdString();
812 std::string val = ui->tableVariables->item(i, 1)->text().toStdString();
813 yarp::os::Bottle valb(val);
814 emit sendSingleRemoteVariable(key, valb);
815 }
817 break;
818 }
819 default:
820 break;
821 }
822
823
824}
825
826void PidDlg::onCancel()
827{
828 reject();
829}
int SIGNAL(int pid, int signum)
void sendForceOffset(int, double)
void initTorquePID(const std::vector< PidWithExtraInfo > &myPids)
Definition piddlg.cpp:406
~PidDlg()
Definition piddlg.cpp:203
void refreshPids(int jointIndex)
void initVelocityDirectPID(const std::vector< PidWithExtraInfo > &myPids)
Definition piddlg.cpp:332
void sendSingleRemoteVariable(std::string key, yarp::os::Bottle val)
void sendPWM(int jointIndex, double dutyVal)
void updateAllRemoteVariables()
void initTorqueOffset(double curForceVal, double minForce, double maxForce)
Definition piddlg.cpp:573
void initMixedPID(const std::vector< PidWithExtraInfo > &myPids)
Definition piddlg.cpp:369
void sendStiffness(int, double, double)
void initCurrentPID(const std::vector< PidWithExtraInfo > &myPids)
Definition piddlg.cpp:591
void initStiffness(double curStiffVal, double minStiff, double maxStiff, double curDampVal, double minDamp, double maxDamp)
Definition piddlg.cpp:559
void initRemoteVariables(IRemoteVariables *iVar)
Definition piddlg.cpp:493
void initPositionDirectPID(const std::vector< PidWithExtraInfo > &myPids)
Definition piddlg.cpp:258
void sendMotorParameters(int jointIndex, MotorTorqueParameters newTorqueParam)
void initMotorParams(MotorTorqueParameters TorqueParam)
Definition piddlg.cpp:443
void dumpRemoteVariables()
void initPWM(double pwmVal, double pwm)
Definition piddlg.cpp:583
void initVelocityPID(const std::vector< PidWithExtraInfo > &myPids)
Definition piddlg.cpp:295
PidDlg(QString partname, int jointIndex, QString jointName, int cmode, QWidget *parent=0)
Definition piddlg.cpp:120
void sendPid(PidControlTypeEnum pidtype, int jointIndex, Pid newPid)
void initPositionPID(const std::vector< PidWithExtraInfo > &myPids)
Definition piddlg.cpp:221
IRemoteVariables interface.
virtual yarp::dev::ReturnValue getRemoteVariablesList(yarp::os::Bottle *listOfKeys)=0
virtual yarp::dev::ReturnValue getRemoteVariable(std::string key, yarp::os::Bottle &val)=0
std::string output_data_description
human-readable description of the output data of pid
std::string input_data_description
human-readable description of the input data of pid
std::string pid_description
human-readable description of the pid controller.
PidDescriptionData description
double ki
integrative gain
double scale
scale for the pid output
double kp
proportional gain
double max_output
max output
double stiction_down_val
down stiction offset added to the pid output
double kff
feedforward gain
double stiction_up_val
up stiction offset added to the pid output
double kd
derivative gain
double offset
pwm offset added to the pid output
double max_int
saturation threshold for the integrator
yarp::dev::PidExtraInfoData pidExtraInfo
Contains the parameters for a PID.
A simple collection of objects that can be described and transmitted in a portable way.
Definition Bottle.h:65
size_type size() const
Gets the number of elements in the bottle.
Definition Bottle.cpp:257
Value & get(size_type index) const
Reads a Value v from a certain part of the list.
Definition Bottle.cpp:252
std::string toString() const override
Gives a human-readable textual representation of the bottle.
Definition Bottle.cpp:217
virtual bool isString() const
Checks if value is a string.
Definition Value.cpp:156
virtual std::string asString() const
Get string value.
Definition Value.cpp:246
Definition aboutdlg.h:11
std::int32_t vocab32_t
Definition numeric.h:78
PidControlTypeEnum
Definition PidEnums.h:15
NetInt32 encode(const std::string &str)
Convert a string into a vocabulary identifier.
Definition Vocab32.cpp:11
std::string decode(NetInt32 code)
Convert a vocabulary identifier into a string.
Definition Vocab32.cpp:33
#define POSITION_KP
Definition piddlg.cpp:26
#define MIXED_MAXINT
Definition piddlg.cpp:75
#define TAB_POSITION
Definition piddlg.cpp:14
#define VELOCITY_STICTIONUP
Definition piddlg.cpp:55
#define TAB_TORQUE
Definition piddlg.cpp:19
#define MIXED_STICTIONDW
Definition piddlg.cpp:78
#define POSITION_DIR_KFF
Definition piddlg.cpp:46
#define TORQUE_STITCTIONUP
Definition piddlg.cpp:88
#define VELOCITY_DIR_MAXOUTPUT
Definition piddlg.cpp:63
#define CURRENT_KFF
Definition piddlg.cpp:109
#define POSITION_KD
Definition piddlg.cpp:27
#define MOTOR_BEMFGAIN
Definition piddlg.cpp:92
#define MOTOR_KTAUGAIN
Definition piddlg.cpp:94
#define CURRENT_KD
Definition piddlg.cpp:103
#define MOTOR_VISCOUSNEG
Definition piddlg.cpp:97
std::string prepareDescription(const PidWithExtraInfo &myPid)
Definition piddlg.cpp:214
#define MOTOR_COULOMBPOS
Definition piddlg.cpp:98
#define POSITION_DIR_SCALE
Definition piddlg.cpp:40
#define TAB_CURRENT
Definition piddlg.cpp:20
#define POSITION_DIR_OFFSET
Definition piddlg.cpp:43
#define POSITION_DIR_STICTIONDW
Definition piddlg.cpp:45
#define CURRENT_KP
Definition piddlg.cpp:102
#define TAB_MIXED
Definition piddlg.cpp:18
int getCurrentTabIndexByName(QTabWidget *tabWidget, const QString &name)
Definition piddlg.cpp:111
#define VELOCITY_KD
Definition piddlg.cpp:49
PidControlTypeEnum choosePIDType(const PidControlTypeEnum &base, int index)
Definition piddlg.cpp:657
#define MOTOR_VELOCITY_THRESHOLD
Definition piddlg.cpp:100
#define MOTOR_COULOMBNEG
Definition piddlg.cpp:99
#define VELOCITY_MAXOUTPUT
Definition piddlg.cpp:52
#define MIXED_MAXOUTPUT
Definition piddlg.cpp:74
#define VELOCITY_DIR_KFF
Definition piddlg.cpp:68
#define POSITION_DIR_KI
Definition piddlg.cpp:39
#define TAB_PWM
Definition piddlg.cpp:23
#define MIXED_KP
Definition piddlg.cpp:70
#define MIXED_OFFSET
Definition piddlg.cpp:76
#define TORQUE_OFFSET
Definition piddlg.cpp:87
#define POSITION_DIR_MAXINT
Definition piddlg.cpp:42
#define VELOCITY_OFFSET
Definition piddlg.cpp:54
#define MOTOR_VISCOUSPOS
Definition piddlg.cpp:96
#define TORQUE_KFF
Definition piddlg.cpp:90
#define VELOCITY_DIR_OFFSET
Definition piddlg.cpp:65
#define VELOCITY_STICTIONDW
Definition piddlg.cpp:56
#define MIXED_KFF
Definition piddlg.cpp:79
#define POSITION_KFF
Definition piddlg.cpp:35
#define VELOCITY_KFF
Definition piddlg.cpp:57
#define MOTOR_KTAUSCALE
Definition piddlg.cpp:95
#define CURRENT_KI
Definition piddlg.cpp:104
#define TAB_VELOCITY
Definition piddlg.cpp:16
#define TAB_VARIABLES
Definition piddlg.cpp:24
#define VELOCITY_DIR_MAXINT
Definition piddlg.cpp:64
#define CURRENT_MAXOUTPUT
Definition piddlg.cpp:106
#define POSITION_DIR_MAXOUTPUT
Definition piddlg.cpp:41
#define VELOCITY_KP
Definition piddlg.cpp:48
#define CURRENT_MAXINT
Definition piddlg.cpp:107
#define TAB_VELOCITY_DIR
Definition piddlg.cpp:17
#define VELOCITY_DIR_KD
Definition piddlg.cpp:60
#define POSITION_OFFSET
Definition piddlg.cpp:32
#define TORQUE_STICTIONDW
Definition piddlg.cpp:89
#define VELOCITY_DIR_KI
Definition piddlg.cpp:61
#define TAB_POSITION_DIR
Definition piddlg.cpp:15
#define VELOCITY_DIR_STICTIONDW
Definition piddlg.cpp:67
#define TORQUE_MAXINT
Definition piddlg.cpp:86
#define VELOCITY_SCALE
Definition piddlg.cpp:51
#define MIXED_STICTIONUP
Definition piddlg.cpp:77
#define CURRENT_OFFSET
Definition piddlg.cpp:108
#define TAB_STIFF
Definition piddlg.cpp:22
#define POSITION_DIR_STICTIONUP
Definition piddlg.cpp:44
#define TORQUE_KD
Definition piddlg.cpp:82
#define POSITION_DIR_KP
Definition piddlg.cpp:37
#define TORQUE_KP
Definition piddlg.cpp:81
#define TAB_MOTORPARAMS
Definition piddlg.cpp:21
#define MIXED_SCALE
Definition piddlg.cpp:73
#define POSITION_STICTIONDW
Definition piddlg.cpp:34
#define TORQUE_KI
Definition piddlg.cpp:83
#define POSITION_STICTIONUP
Definition piddlg.cpp:33
#define TORQUE_SCALE
Definition piddlg.cpp:84
#define VELOCITY_MAXINT
Definition piddlg.cpp:53
#define MOTOR_BEMFSCALE
Definition piddlg.cpp:93
#define VELOCITY_DIR_STICTIONUP
Definition piddlg.cpp:66
#define POSITION_SCALE
Definition piddlg.cpp:29
#define VELOCITY_DIR_SCALE
Definition piddlg.cpp:62
#define POSITION_MAXOUTPUT
Definition piddlg.cpp:30
#define POSITION_KI
Definition piddlg.cpp:28
#define VELOCITY_DIR_KP
Definition piddlg.cpp:59
#define CURRENT_SCALE
Definition piddlg.cpp:105
#define POSITION_MAXINT
Definition piddlg.cpp:31
#define POSITION_DIR_KD
Definition piddlg.cpp:38
#define TORQUE_MAXOUTPUT
Definition piddlg.cpp:85
#define MIXED_KI
Definition piddlg.cpp:72
#define MIXED_KD
Definition piddlg.cpp:71
#define VELOCITY_KI
Definition piddlg.cpp:50