15#define TAB_POSITION_DIR 1
17#define TAB_VELOCITY_DIR 3
21#define TAB_MOTORPARAMS 7
24#define TAB_VARIABLES 10
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
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
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
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
74#define MIXED_MAXOUTPUT 4
77#define MIXED_STICTIONUP 7
78#define MIXED_STICTIONDW 8
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
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
105#define CURRENT_SCALE 3
106#define CURRENT_MAXOUTPUT 4
107#define CURRENT_MAXINT 5
108#define CURRENT_OFFSET 6
112 for (
int i = 0; i < tabWidget->count(); ++i) {
113 if (tabWidget->tabText(i) == name) {
120PidDlg::PidDlg(QString partname,
int jointIndex, QString jointName,
int cmode, QWidget *parent) :
154 ui->tabMain->setCurrentIndex(0);
158 this->jointIndex = jointIndex;
160 QString title = QString(
"Pid Control %1 JNT:%2 (%3)").arg(partname).arg(jointIndex).arg(jointName);
161 setWindowTitle(title);
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)));
174 connect(ui->tableStiffness, &QTableWidget::itemChanged,
this, [
this](QTableWidgetItem* item)
176 if (item == ui->tableStiffness->item(2, 3))
178 onForceOffsetChanged(item->text());
193void PidDlg::onForceOffsetChanged(QString forceOffset)
195 forceOffsetChanged =
true;
198void PidDlg::onDumpRemoteVariables()
205 for (
auto& button : buttons)
223 size_t pidindex = ui->selectPosition->currentIndex();
225 ui->descPosition->setText(QString(
"%1").arg(desc.c_str()));
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));
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));
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));
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));
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));
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));
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));
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));
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));
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));
260 size_t pidindex = ui->selectPositionDir->currentIndex();
262 ui->descPositionDir->setText(QString(
"%1").arg(desc.c_str()));
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));
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));
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));
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));
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));
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));
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));
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));
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));
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));
297 size_t pidindex = ui->selectVelocity->currentIndex();
299 ui->descVelocity->setText(QString(
"%1").arg(desc.c_str()));
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));
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));
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));
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));
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));
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));
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));
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));
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));
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));
334 size_t pidindex = ui->selectVelocityDir->currentIndex();
336 ui->descVelocityDir->setText(QString(
"%1").arg(desc.c_str()));
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));
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));
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));
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));
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));
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));
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));
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));
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));
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));
371 size_t pidindex = ui->selectMixed->currentIndex();
373 ui->descMixed->setText(QString(
"%1").arg(desc.c_str()));
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));
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));
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));
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));
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));
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));
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));
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));
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));
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));
408 size_t pidindex = ui->selectTorque->currentIndex();
410 ui->descTorque->setText(QString(
"%1").arg(desc.c_str()));
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));
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));
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));
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));
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));
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));
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));
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));
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));
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));
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));
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));
471void PidDlg::onSendRemoteVariable()
474 for (
size_t elem = 0; elem < buttons.size(); elem++)
476 if (sender() == buttons[elem])
486 std::string key = ui->tableVariables->item(i, 0)->text().toStdString();
487 std::string val = ui->tableVariables->item(i, 1)->text().toStdString();
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(
"")));
514 int keys_size = keys.
size();
515 for (
auto& button : buttons)
521 buttons.resize(keys_size);
523 for (
int i = 0; i < keys_size; i++)
525 buttons[i] =
new QPushButton(
"Send");
526 connect(buttons[i],
SIGNAL(clicked()),
this, SLOT(onSendRemoteVariable()));
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]);
560 double curDampVal,
double minDamp,
double maxDamp)
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));
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));
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;
585 ui->tablePWM->item(0, 0)->setText(QString(
"%1").arg((
double)PWMVal));
586 ui->tablePWM->item(0, 1)->setText(QString(
"%1").arg((
double)PWMVal));
588 ui->tablePWM->item(1,0)->setText(QString(
"%1").arg(pwm));
593 size_t pidindex = ui->selectCurrent->currentIndex();
595 ui->descCurrent->setText(QString(
"%1").arg(desc.c_str()));
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));
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));
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));
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));
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));
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));
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));
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));
622void PidDlg::onRefresh()
627void PidDlg::onComboBoxIndexChangedPos(
int selection)
631void PidDlg::onComboBoxIndexChangedVel(
int selection)
635void PidDlg::onComboBoxIndexChangedPosDir(
int selection)
639void PidDlg::onComboBoxIndexChangedVelDir(
int selection)
643void PidDlg::onComboBoxIndexChangedMix(
int selection)
647void PidDlg::onComboBoxIndexChangedTrq(
int selection)
651void PidDlg::onComboBoxIndexChangedCur(
int selection)
660 pidtyped[3] = index +
'0';
670 int combo_selection=0;
672 switch (ui->tabMain->currentIndex()) {
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();
686 emit
sendPid(pidtype, jointIndex,newPid);
689 combo_selection = ui->selectPositionDir->currentIndex();
690 pidtype =
choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_POSITION_DIRECT, combo_selection+1);
701 emit
sendPid(pidtype, jointIndex,newPid);
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();
716 emit
sendPid(pidtype, jointIndex, newPid);
719 combo_selection = ui->selectVelocityDir->currentIndex();
720 pidtype =
choosePIDType(PidControlTypeEnum::VOCAB_PIDTYPE_VELOCITY_DIRECT, combo_selection+1);
731 emit
sendPid(pidtype, jointIndex, newPid);
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();
746 emit
sendPid(pidtype, jointIndex, newPid);
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();
761 emit
sendPid(pidtype, jointIndex,newPid);
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();
774 emit
sendPid(pidtype, jointIndex, newPid);
778 newMotorTorqueParams.
bemf = ui->tableMotorParams->item(
MOTOR_BEMFGAIN,1)->text().toDouble();
780 newMotorTorqueParams.
ktau = ui->tableMotorParams->item(
MOTOR_KTAUGAIN,1)->text().toDouble();
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();
794 if (forceOffsetChanged)
797 forceOffsetChanged =
false;
802 int desiredDuty = ui->tablePWM->item(0,1)->text().toDouble();
803 emit
sendPWM(jointIndex,desiredDuty);
808 int rows = ui->tableVariables->rowCount();
809 for (
int i = 0; i < rows; i++)
811 std::string key = ui->tableVariables->item(i, 0)->text().toStdString();
812 std::string val = ui->tableVariables->item(i, 1)->text().toStdString();
826void PidDlg::onCancel()
int SIGNAL(int pid, int signum)
void sendForceOffset(int, double)
void initTorquePID(const std::vector< PidWithExtraInfo > &myPids)
void refreshPids(int jointIndex)
void initVelocityDirectPID(const std::vector< PidWithExtraInfo > &myPids)
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)
void initMixedPID(const std::vector< PidWithExtraInfo > &myPids)
void sendStiffness(int, double, double)
void initCurrentPID(const std::vector< PidWithExtraInfo > &myPids)
void initStiffness(double curStiffVal, double minStiff, double maxStiff, double curDampVal, double minDamp, double maxDamp)
void initRemoteVariables(IRemoteVariables *iVar)
void initPositionDirectPID(const std::vector< PidWithExtraInfo > &myPids)
void sendMotorParameters(int jointIndex, MotorTorqueParameters newTorqueParam)
void initMotorParams(MotorTorqueParameters TorqueParam)
void dumpRemoteVariables()
void initPWM(double pwmVal, double pwm)
void initVelocityPID(const std::vector< PidWithExtraInfo > &myPids)
PidDlg(QString partname, int jointIndex, QString jointName, int cmode, QWidget *parent=0)
void sendPid(PidControlTypeEnum pidtype, int jointIndex, Pid newPid)
void initPositionPID(const std::vector< PidWithExtraInfo > &myPids)
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.
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 offset
pwm offset added to the pid output
double max_int
saturation threshold for the integrator
Contains the parameters for a PID.
A simple collection of objects that can be described and transmitted in a portable way.
size_type size() const
Gets the number of elements in the bottle.
Value & get(size_type index) const
Reads a Value v from a certain part of the list.
std::string toString() const override
Gives a human-readable textual representation of the bottle.
virtual bool isString() const
Checks if value is a string.
virtual std::string asString() const
Get string value.
NetInt32 encode(const std::string &str)
Convert a string into a vocabulary identifier.
std::string decode(NetInt32 code)
Convert a vocabulary identifier into a string.
#define VELOCITY_STICTIONUP
#define TORQUE_STITCTIONUP
#define VELOCITY_DIR_MAXOUTPUT
std::string prepareDescription(const PidWithExtraInfo &myPid)
#define POSITION_DIR_SCALE
#define POSITION_DIR_OFFSET
#define POSITION_DIR_STICTIONDW
int getCurrentTabIndexByName(QTabWidget *tabWidget, const QString &name)
PidControlTypeEnum choosePIDType(const PidControlTypeEnum &base, int index)
#define MOTOR_VELOCITY_THRESHOLD
#define VELOCITY_MAXOUTPUT
#define POSITION_DIR_MAXINT
#define VELOCITY_DIR_OFFSET
#define VELOCITY_STICTIONDW
#define VELOCITY_DIR_MAXINT
#define CURRENT_MAXOUTPUT
#define POSITION_DIR_MAXOUTPUT
#define TORQUE_STICTIONDW
#define VELOCITY_DIR_STICTIONDW
#define POSITION_DIR_STICTIONUP
#define POSITION_STICTIONDW
#define POSITION_STICTIONUP
#define VELOCITY_DIR_STICTIONUP
#define VELOCITY_DIR_SCALE
#define POSITION_MAXOUTPUT