27 #include <QVBoxLayout>
28 #include <QFormLayout>
29 #include <QTableWidget>
32 #include <RobotAPI/interface/core/FramedPoseBase.h>
33 #include <RobotAPI/interface/core/LinkedPoseBase.h>
34 #include <RobotAPI/interface/core/OrientedPoint.h>
35 #include <RobotAPI/interface/core/PoseBase.h>
49 auto l =
new QFormLayout;
50 l->setContentsMargins(0, 0, 0, 0);
54 l->addRow(
"X", labelX);
55 l->addRow(
"Y", labelY);
58 void update(
const VariantDataPtr& p)
override
60 Vector2BasePtr
v = Vector2BasePtr::dynamicCast(p);
62 labelX->setText(QString::number(
v->x));
63 labelY->setText(QString::number(
v->y));
77 auto l =
new QFormLayout;
78 l->setContentsMargins(0, 0, 0, 0);
83 l->addRow(
"X", labelX);
84 l->addRow(
"Y", labelY);
85 l->addRow(
"Z", labelZ);
88 void update(
const VariantDataPtr& p)
override
90 Vector3BasePtr
v = Vector3BasePtr::dynamicCast(p);
92 labelX->setText(QString::number(
v->x));
93 labelY->setText(QString::number(
v->y));
94 labelZ->setText(QString::number(
v->z));
109 auto l =
new QFormLayout;
110 l->setContentsMargins(0, 0, 0, 0);
112 labelAg =
new QLabel;
113 labelFr =
new QLabel;
117 l->addRow(
"Agent", labelAg);
118 l->addRow(
"Frame", labelFr);
119 l->addRow(
"X", labelX);
120 l->addRow(
"Y", labelY);
121 l->addRow(
"Z", labelZ);
124 void update(
const VariantDataPtr& p)
override
126 FramedPositionBasePtr
v = FramedPositionBasePtr::dynamicCast(p);
128 labelAg->setText(QString::fromStdString(
v->agent));
129 labelFr->setText(QString::fromStdString(
v->frame));
130 labelX->setText(QString::number(
v->x));
131 labelY->setText(QString::number(
v->y));
132 labelZ->setText(QString::number(
v->z));
149 auto l =
new QFormLayout;
150 l->setContentsMargins(0, 0, 0, 0);
152 labelAg =
new QLabel;
153 labelFr =
new QLabel;
157 l->addRow(
"Agent", labelAg);
158 l->addRow(
"Frame", labelFr);
159 l->addRow(
"X", labelX);
160 l->addRow(
"Y", labelY);
161 l->addRow(
"Z", labelZ);
164 void update(
const VariantDataPtr& p)
override
166 FramedDirectionBasePtr
v = FramedDirectionBasePtr::dynamicCast(p);
168 labelAg->setText(QString::fromStdString(
v->agent));
169 labelFr->setText(QString::fromStdString(
v->frame));
170 labelX->setText(QString::number(
v->x));
171 labelY->setText(QString::number(
v->y));
172 labelZ->setText(QString::number(
v->z));
189 auto l =
new QFormLayout;
190 l->setContentsMargins(0, 0, 0, 0);
192 labelPX =
new QLabel;
193 labelPY =
new QLabel;
194 labelPZ =
new QLabel;
195 labelNX =
new QLabel;
196 labelNY =
new QLabel;
197 labelNZ =
new QLabel;
198 l->addRow(
"PX", labelPX);
199 l->addRow(
"PY", labelPY);
200 l->addRow(
"PZ", labelPZ);
201 l->addRow(
"NX", labelNX);
202 l->addRow(
"NY", labelNY);
203 l->addRow(
"NZ", labelNZ);
206 void update(
const VariantDataPtr& p)
override
208 OrientedPointBasePtr
v = OrientedPointBasePtr::dynamicCast(p);
210 labelPX->setText(QString::number(
v->px));
211 labelPY->setText(QString::number(
v->py));
212 labelPZ->setText(QString::number(
v->pz));
213 labelNX->setText(QString::number(
v->nx));
214 labelNY->setText(QString::number(
v->ny));
215 labelNZ->setText(QString::number(
v->nz));
233 auto l =
new QFormLayout;
234 l->setContentsMargins(0, 0, 0, 0);
236 labelAg =
new QLabel;
237 labelFr =
new QLabel;
238 labelPX =
new QLabel;
239 labelPY =
new QLabel;
240 labelPZ =
new QLabel;
241 labelNX =
new QLabel;
242 labelNY =
new QLabel;
243 labelNZ =
new QLabel;
244 l->addRow(
"Agent", labelAg);
245 l->addRow(
"Frame", labelFr);
246 l->addRow(
"PX", labelPX);
247 l->addRow(
"PY", labelPY);
248 l->addRow(
"PZ", labelPZ);
249 l->addRow(
"NX", labelNX);
250 l->addRow(
"NY", labelNY);
251 l->addRow(
"NZ", labelNZ);
254 void update(
const VariantDataPtr& p)
override
256 FramedOrientedPointBasePtr
v = FramedOrientedPointBasePtr::dynamicCast(p);
258 labelAg->setText(QString::fromStdString(
v->agent));
259 labelFr->setText(QString::fromStdString(
v->frame));
260 labelPX->setText(QString::number(
v->px));
261 labelPY->setText(QString::number(
v->py));
262 labelPZ->setText(QString::number(
v->pz));
263 labelNX->setText(QString::number(
v->nx));
264 labelNY->setText(QString::number(
v->ny));
265 labelNZ->setText(QString::number(
v->nz));
285 auto l =
new QFormLayout;
286 l->setContentsMargins(0, 0, 0, 0);
288 labelQW =
new QLabel;
289 labelQX =
new QLabel;
290 labelQY =
new QLabel;
291 labelQZ =
new QLabel;
292 l->addRow(
"QW", labelQW);
293 l->addRow(
"QX", labelQX);
294 l->addRow(
"QY", labelQY);
295 l->addRow(
"QZ", labelQZ);
298 void update(
const VariantDataPtr& p)
override
300 QuaternionBasePtr
v = QuaternionBasePtr::dynamicCast(p);
302 labelQW->setText(QString::number(
v->qw));
303 labelQX->setText(QString::number(
v->qx));
304 labelQY->setText(QString::number(
v->qy));
305 labelQZ->setText(QString::number(
v->qz));
321 auto l =
new QFormLayout;
322 l->setContentsMargins(0, 0, 0, 0);
324 labelAg =
new QLabel;
325 labelFr =
new QLabel;
326 labelQW =
new QLabel;
327 labelQX =
new QLabel;
328 labelQY =
new QLabel;
329 labelQZ =
new QLabel;
330 l->addRow(
"Agent", labelAg);
331 l->addRow(
"Frame", labelFr);
332 l->addRow(
"QW", labelQW);
333 l->addRow(
"QX", labelQX);
334 l->addRow(
"QY", labelQY);
335 l->addRow(
"QZ", labelQZ);
338 void update(
const VariantDataPtr& p)
override
340 FramedOrientationBasePtr
v = FramedOrientationBasePtr::dynamicCast(p);
342 labelAg->setText(QString::fromStdString(
v->agent));
343 labelFr->setText(QString::fromStdString(
v->frame));
344 labelQW->setText(QString::number(
v->qw));
345 labelQX->setText(QString::number(
v->qx));
346 labelQY->setText(QString::number(
v->qy));
347 labelQZ->setText(QString::number(
v->qz));
365 auto l =
new QFormLayout;
366 l->setContentsMargins(0, 0, 0, 0);
371 labelQW =
new QLabel;
372 labelQX =
new QLabel;
373 labelQY =
new QLabel;
374 labelQZ =
new QLabel;
375 l->addRow(
"X", labelX);
376 l->addRow(
"Y", labelY);
377 l->addRow(
"Z", labelZ);
378 l->addRow(
"QW", labelQW);
379 l->addRow(
"QX", labelQX);
380 l->addRow(
"QY", labelQY);
381 l->addRow(
"QZ", labelQZ);
384 void update(
const VariantDataPtr& p)
override
386 PoseBasePtr
v = PoseBasePtr::dynamicCast(p);
390 labelX->setText(QString::number(
v->position->x));
391 labelY->setText(QString::number(
v->position->y));
392 labelZ->setText(QString::number(
v->position->z));
393 labelQW->setText(QString::number(
v->orientation->qw));
394 labelQX->setText(QString::number(
v->orientation->qx));
395 labelQY->setText(QString::number(
v->orientation->qy));
396 labelQZ->setText(QString::number(
v->orientation->qz));
415 auto l =
new QFormLayout;
416 l->setContentsMargins(0, 0, 0, 0);
418 labelAg =
new QLabel;
419 labelFr =
new QLabel;
423 labelQW =
new QLabel;
424 labelQX =
new QLabel;
425 labelQY =
new QLabel;
426 labelQZ =
new QLabel;
427 l->addRow(
"Agent", labelAg);
428 l->addRow(
"Frame", labelFr);
429 l->addRow(
"X", labelX);
430 l->addRow(
"Y", labelY);
431 l->addRow(
"Z", labelZ);
432 l->addRow(
"QW", labelQW);
433 l->addRow(
"QX", labelQX);
434 l->addRow(
"QY", labelQY);
435 l->addRow(
"QZ", labelQZ);
438 void update(
const VariantDataPtr& p)
override
440 FramedPoseBasePtr
v = FramedPoseBasePtr::dynamicCast(p);
444 labelAg->setText(QString::fromStdString(
v->agent));
445 labelFr->setText(QString::fromStdString(
v->frame));
446 labelX->setText(QString::number(
v->position->x));
447 labelY->setText(QString::number(
v->position->y));
448 labelZ->setText(QString::number(
v->position->z));
449 labelQW->setText(QString::number(
v->orientation->qw));
450 labelQX->setText(QString::number(
v->orientation->qx));
451 labelQY->setText(QString::number(
v->orientation->qy));
452 labelQZ->setText(QString::number(
v->orientation->qz));